diff --git a/conf/airframes/tudelft/neddrone4.xml b/conf/airframes/tudelft/neddrone4.xml index e9e19c7de8..51edac69e1 100644 --- a/conf/airframes/tudelft/neddrone4.xml +++ b/conf/airframes/tudelft/neddrone4.xml @@ -22,10 +22,7 @@ - - - @@ -351,6 +348,7 @@ + diff --git a/conf/airframes/tudelft/neddrone5.xml b/conf/airframes/tudelft/neddrone5.xml index c0311fd7ef..998c3b3af6 100644 --- a/conf/airframes/tudelft/neddrone5.xml +++ b/conf/airframes/tudelft/neddrone5.xml @@ -357,6 +357,7 @@ + diff --git a/sw/airborne/modules/sensors/airspeed_ets.c b/sw/airborne/modules/sensors/airspeed_ets.c index e4d40455a3..be01618bd4 100644 --- a/sw/airborne/modules/sensors/airspeed_ets.c +++ b/sw/airborne/modules/sensors/airspeed_ets.c @@ -45,6 +45,7 @@ #include "mcu_periph/uart.h" #include "mcu_periph/sys_time.h" #include "pprzlink/messages.h" +#include "subsystems/abi.h" #include "subsystems/datalink/downlink.h" #include @@ -225,6 +226,10 @@ void airspeed_ets_read_event(void) airspeed_ets += airspeed_ets_buffer[n]; } airspeed_ets = airspeed_ets / (float)AIRSPEED_ETS_NBSAMPLES_AVRG; + + // Publish airspeed sensor + AbiSendMsgAIRSPEED(AIRSPEED_ETS_ID, airspeed_ets); + #if USE_AIRSPEED_ETS stateSetAirspeed_f(airspeed_ets); #endif diff --git a/sw/airborne/subsystems/abi_sender_ids.h b/sw/airborne/subsystems/abi_sender_ids.h index c3fc075be7..d0460e4782 100644 --- a/sw/airborne/subsystems/abi_sender_ids.h +++ b/sw/airborne/subsystems/abi_sender_ids.h @@ -107,6 +107,10 @@ #define AIRSPEED_SDP3X_ID 3 #endif +#ifndef AIRSPEED_ETS_ID +#define AIRSPEED_ETS_ID 4 +#endif + /* * IDs of Incidence angles (message 24) */