mirror of
https://github.com/betaflight/betaflight.git
synced 2025-07-21 15:25:36 +03:00
GPS - quick hack to parse the received GPS data and update the OLED
display in GPS passthough mode.
This commit is contained in:
parent
1d5c2fb13e
commit
39f9b799d3
1 changed files with 19 additions and 5 deletions
|
@ -48,6 +48,10 @@
|
|||
|
||||
#include "io/gps.h"
|
||||
|
||||
// FIXME quick hack to allow usage of the display in gps passthough mode.
|
||||
void updateDisplay(void);
|
||||
|
||||
|
||||
#ifdef GPS
|
||||
|
||||
extern int16_t debug[4];
|
||||
|
@ -905,15 +909,18 @@ static bool gpsNewFrameUBLOX(uint8_t data)
|
|||
break;
|
||||
case 8:
|
||||
_step = 0;
|
||||
if (_ck_b != data)
|
||||
if (_ck_b != data) {
|
||||
break; // bad checksum
|
||||
}
|
||||
|
||||
if (_skip_packet)
|
||||
if (_skip_packet) {
|
||||
break;
|
||||
}
|
||||
|
||||
if (UBLOX_parse_gps())
|
||||
if (UBLOX_parse_gps()) {
|
||||
parsed = true;
|
||||
} //end switch
|
||||
}
|
||||
}
|
||||
return parsed;
|
||||
}
|
||||
|
||||
|
@ -937,10 +944,13 @@ gpsEnablePassthroughResult_e gpsEnablePassthrough(void)
|
|||
LED0_OFF;
|
||||
LED1_OFF;
|
||||
|
||||
char c;
|
||||
while(1) {
|
||||
if (serialTotalBytesWaiting(gpsPort)) {
|
||||
LED0_ON;
|
||||
serialWrite(gpsPassthroughPort, serialRead(gpsPort));
|
||||
c = serialRead(gpsPort);
|
||||
gpsNewData(c);
|
||||
serialWrite(gpsPassthroughPort, c);
|
||||
LED0_OFF;
|
||||
}
|
||||
if (serialTotalBytesWaiting(gpsPassthroughPort)) {
|
||||
|
@ -948,6 +958,10 @@ gpsEnablePassthroughResult_e gpsEnablePassthrough(void)
|
|||
serialWrite(gpsPort, serialRead(gpsPassthroughPort));
|
||||
LED1_OFF;
|
||||
}
|
||||
if (feature(FEATURE_DISPLAY)) {
|
||||
updateDisplay();
|
||||
}
|
||||
|
||||
}
|
||||
return GPS_PASSTHROUGH_ENABLED;
|
||||
}
|
||||
|
|
Loading…
Add table
Add a link
Reference in a new issue