rusefi
/
atbetaflight
mirror of https://github.com/rusefi/atbetaflight.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Added climbrate m/s and m/3s to Hott EAM

This commit is contained in:
Michi 2017-03-15 19:57:45 +01:00
parent 6303de7650
commit 1689b84642
1 changed files with 10 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
src/main/telemetry/hott.c
View File

@ -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)