diff --git a/src/main/telemetry/hott.c b/src/main/telemetry/hott.c index dfae08c7e..2860c1abc 100644 --- a/src/main/telemetry/hott.c +++ b/src/main/telemetry/hott.c @@ -267,6 +267,14 @@ static inline void hottEAMUpdateBatteryDrawnCapacity(HOTT_EAM_MSG_t *hottEAMMess hottEAMMessage->batt_cap_H = mAh >> 8; } +static inline void hottEAMUpdateAltitude(HOTT_EAM_MSG_t *hottEAMMessage) +{ + const uint16_t hottEamAltitude = (baro.BaroAlt / 100) + HOTT_EAM_OFFSET_HEIGHT; + + hottEAMMessage->altitude_L = hottEamAltitude & 0x00FF; + hottEAMMessage->altitude_H = hottEamAltitude >> 8; +} + void hottPrepareEAMResponse(HOTT_EAM_MSG_t *hottEAMMessage) { // Reset alarms @@ -276,6 +284,7 @@ void hottPrepareEAMResponse(HOTT_EAM_MSG_t *hottEAMMessage) hottEAMUpdateBattery(hottEAMMessage); hottEAMUpdateCurrentMeter(hottEAMMessage); hottEAMUpdateBatteryDrawnCapacity(hottEAMMessage); + hottEAMUpdateAltitude(hottEAMMessage); } static void hottSerialWrite(uint8_t c)