From 1689b846422bf5362931f5525b099a5d034d3ec1 Mon Sep 17 00:00:00 2001 From: Michi Date: Wed, 15 Mar 2017 19:57:45 +0100 Subject: [PATCH] Added climbrate m/s and m/3s to Hott EAM --- src/main/telemetry/hott.c | 10 ++++++++++ 1 file changed, 10 insertions(+) diff --git a/src/main/telemetry/hott.c b/src/main/telemetry/hott.c index 2860c1abc..de4318bf7 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)