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

Fixed GPS init on SmartPort.

This commit is contained in:
mikeller 2018-06-24 12:39:03 +12:00
parent 95dcce8471
commit 4eaf28f4da
1 changed files with 5 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
src/main/telemetry/smartport.c
View File

@ -361,7 +361,7 @@ static void initSmartPortSensors(void)
} }
#ifdef USE_GPS #ifdef USE_GPS
if (sensors(SENSOR_GPS)) { if (feature(FEATURE_GPS)) {
ADD_SENSOR(FSSP_DATAID_SPEED); ADD_SENSOR(FSSP_DATAID_SPEED);
ADD_SENSOR(FSSP_DATAID_LATLONG); ADD_SENSOR(FSSP_DATAID_LATLONG);
ADD_SENSOR(FSSP_DATAID_LATLONG); // twice (one for lat, one for long) ADD_SENSOR(FSSP_DATAID_LATLONG); // twice (one for lat, one for long)
@ -703,16 +703,17 @@ void processSmartPortTelemetry(smartPortPayload_t *payload, volatile bool *clear
*clearToSend = false; *clearToSend = false;
break; break;
case FSSP_DATAID_T2 : case FSSP_DATAID_T2 :
if (sensors(SENSOR_GPS)) {
#ifdef USE_GPS #ifdef USE_GPS
if (sensors(SENSOR_GPS)) {
// provide GPS lock status // provide GPS lock status
smartPortSendPackage(id, (STATE(GPS_FIX) ? 1000 : 0) + (STATE(GPS_FIX_HOME) ? 2000 : 0) + gpsSol.numSat); smartPortSendPackage(id, (STATE(GPS_FIX) ? 1000 : 0) + (STATE(GPS_FIX_HOME) ? 2000 : 0) + gpsSol.numSat);
*clearToSend = false; *clearToSend = false;
#endif
} else if (feature(FEATURE_GPS)) { } else if (feature(FEATURE_GPS)) {
smartPortSendPackage(id, 0); smartPortSendPackage(id, 0);
*clearToSend = false; *clearToSend = false;
} else if (telemetryConfig()->pidValuesAsTelemetry) { } else
#endif
if (telemetryConfig()->pidValuesAsTelemetry) {
switch (t2Cnt) { switch (t2Cnt) {
case 0: case 0:
tmp2 = currentPidProfile->pid[PID_ROLL].P; tmp2 = currentPidProfile->pid[PID_ROLL].P;