diff --git a/sw/airborne/subsystems/actuators/motor_mixing.c b/sw/airborne/subsystems/actuators/motor_mixing.c index 0e15e9e6b3..3f587ee3b2 100644 --- a/sw/airborne/subsystems/actuators/motor_mixing.c +++ b/sw/airborne/subsystems/actuators/motor_mixing.c @@ -93,6 +93,19 @@ static const int32_t thrust_coef[MOTOR_MIXING_NB_MOTOR] = MOTOR_MIXING_THRUST_CO struct MotorMixing motor_mixing; +#if PERIODIC_TELEMETRY +#include "subsystems/datalink/telemetry.h" +static void send_motor_mixing(struct transport_tx *trans, struct link_device *dev) +{ + int16_t motors[MOTOR_MIXING_NB_MOTOR]; + for (uint8_t i = 0; i < MOTOR_MIXING_NB_MOTOR; i++) + { + motors[i] = (int16_t)motor_mixing.commands[i]; + } + pprz_msg_send_MOTOR_MIXING(trans, dev, AC_ID , MOTOR_MIXING_NB_MOTOR, motors); +} +#endif + void motor_mixing_init(void) { uint8_t i; @@ -107,6 +120,9 @@ void motor_mixing_init(void) } motor_mixing.nb_failure = 0; motor_mixing.nb_saturation = 0; +#if PERIODIC_TELEMETRY + register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_MOTOR_MIXING, send_motor_mixing); +#endif } static void offset_commands(int32_t offset) diff --git a/sw/ext/pprzlink b/sw/ext/pprzlink index a3663ad2d3..a5296431f9 160000 --- a/sw/ext/pprzlink +++ b/sw/ext/pprzlink @@ -1 +1 @@ -Subproject commit a3663ad2d304fbea69489bbf67d59bd68166bd0b +Subproject commit a5296431f96587364f55270a19c05b4dd9395164