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

OSD Hud + LoRa radar (nearby aircrafts) (#4558)

Browse source
This commit is contained in:
Olivier C 2019-05-24 15:37:54 +02:00 • committed by Michel Pastor
parent 39d2a956e9
commit 468a040801
13 changed files with 699 additions and 104 deletions
Download patch file Download diff file Expand all files Collapse all files

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

@ -2395,6 +2395,19 @@ static mspResult_e mspFcProcessInCommand(uint16_t cmdMSP, sbuf_t *src)
} else
return MSP_RESULT_ERROR;
break;
case MSP2_COMMON_SET_RADAR_POS:
if (dataSize >= 19) {
const uint8_t msp_radar_no = MIN(sbufReadU8(src), RADAR_MAX_POIS - 1); // Radar poi number, 0 to 3
radar_pois[msp_radar_no].state = sbufReadU8(src); // 0=undefined, 1=armed, 2=lost
radar_pois[msp_radar_no].gps.lat = sbufReadU32(src); // lat 10E7
radar_pois[msp_radar_no].gps.lon = sbufReadU32(src); // lon 10E7
radar_pois[msp_radar_no].gps.alt = sbufReadU32(src); // altitude (cm)
radar_pois[msp_radar_no].heading = sbufReadU16(src); // °
radar_pois[msp_radar_no].speed = sbufReadU16(src); // cm/s
radar_pois[msp_radar_no].lq = sbufReadU8(src); // Link quality, from 0 to 4
} else
return MSP_RESULT_ERROR;
break;
#endif
case MSP_SET_FEATURE: