Mirror/inav
1
0
Fork 0
mirror of https://github.com/iNavFlight/inav.git synced 2025-07-25 17:25:18 +03:00
Code Issues Wiki Activity

Merge pull request #1186 from iNavFlight/raw-baro-sensor-reporting

Browse source 
Report raw BARO via MSP_ALTITUDE message
This commit is contained in:
Martin Budden 2017-01-29 21:01:52 +00:00 • committed by GitHub
commit 6d36311714
3 changed files with 13 additions and 2 deletions
Download patch file Download diff file Expand all files Collapse all files

9
src/main/fc/fc_msp.c
View file

@ -644,11 +644,16 @@ static bool mspFcProcessOutCommand(uint8_t cmdMSP, sbuf_t *dst, mspPostProcessFn
case MSP_ALTITUDE:
#if defined(NAV)
sbufWriteU32(dst, (uint32_t)lrintf(getEstimatedActualPosition(Z)));
sbufWriteU16(dst, (uint32_t)lrintf(getEstimatedActualVelocity(Z)));
sbufWriteU32(dst, lrintf(getEstimatedActualPosition(Z)));
sbufWriteU16(dst, lrintf(getEstimatedActualVelocity(Z)));
#else
sbufWriteU32(dst, 0);
sbufWriteU16(dst, 0);
#endif
#if defined(BARO)
sbufWriteU32(dst, baroGetLatestAltitude());
#else
sbufWriteU32(dst, 0);
#endif
break;