Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-25 09:16:07 +03:00
Code Issues Wiki Activity

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

Browse source
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
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 "flight/navigation.h"
#include "io/gps.h" #include "io/gps.h"
#include "flight/altitudehold.h"
#include "telemetry/telemetry.h" #include "telemetry/telemetry.h"
#include "telemetry/hott.h" #include "telemetry/hott.h"
@ -275,6 +277,13 @@ static inline void hottEAMUpdateAltitude(HOTT_EAM_MSG_t *hottEAMMessage)
hottEAMMessage->altitude_H = hottEamAltitude >> 8; 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) void hottPrepareEAMResponse(HOTT_EAM_MSG_t *hottEAMMessage)
{ {
// Reset alarms // Reset alarms
@ -285,6 +294,7 @@ void hottPrepareEAMResponse(HOTT_EAM_MSG_t *hottEAMMessage)
hottEAMUpdateCurrentMeter(hottEAMMessage); hottEAMUpdateCurrentMeter(hottEAMMessage);
hottEAMUpdateBatteryDrawnCapacity(hottEAMMessage); hottEAMUpdateBatteryDrawnCapacity(hottEAMMessage);
hottEAMUpdateAltitude(hottEAMMessage); hottEAMUpdateAltitude(hottEAMMessage);
hottEAMUpdateClimbrate(hottEAMMessage);
} }
static void hottSerialWrite(uint8_t c) static void hottSerialWrite(uint8_t c)