diff --git a/src/main/telemetry/hott.c b/src/main/telemetry/hott.c index 2860c1abc3..de4318bf75 100644 --- a/src/main/telemetry/hott.c +++ b/src/main/telemetry/hott.c @@ -84,6 +84,8 @@ #include "flight/navigation.h" #include "io/gps.h" +#include "flight/altitudehold.h" + #include "telemetry/telemetry.h" #include "telemetry/hott.h" @@ -275,6 +277,13 @@ static inline void hottEAMUpdateAltitude(HOTT_EAM_MSG_t *hottEAMMessage) hottEAMMessage->altitude_H = hottEamAltitude >> 8; } +static inline void hottEAMUpdateClimbrate(HOTT_EAM_MSG_t *hottEAMMessage) +{ + hottEAMMessage->climbrate_L = (30000 + vario) & 0x00FF; + hottEAMMessage->climbrate_H = (30000 + vario) >> 8; + hottEAMMessage->climbrate3s = 120 + (vario / 100); +} + void hottPrepareEAMResponse(HOTT_EAM_MSG_t *hottEAMMessage) { // Reset alarms @@ -285,6 +294,7 @@ void hottPrepareEAMResponse(HOTT_EAM_MSG_t *hottEAMMessage) hottEAMUpdateCurrentMeter(hottEAMMessage); hottEAMUpdateBatteryDrawnCapacity(hottEAMMessage); hottEAMUpdateAltitude(hottEAMMessage); + hottEAMUpdateClimbrate(hottEAMMessage); } static void hottSerialWrite(uint8_t c)