mirror
/
esp32-ogn-tracker
kopia lustrzana https://github.com/pjalocha/esp32-ogn-tracker
1
0
Forkuj 0
Kod Zgłoszenia Projekty Wydania Wiki Aktywność

Navigation rate change would not work, now fixed

pull/39/head
Pawel Jalocha 2021-05-06 02:45:40 +01:00
rodzic 381a3029e5
commit 0a985e4789
1 zmienionych plików z 7 dodań i 1 usunięć
Pokaż statystyki Ściągnij plik aktualizacji Ściągnij plik porównania Expand all files Collapse all files

8
main/gps.cpp
Wyświetl plik

@ -308,14 +308,18 @@ static void GPS_BurstStart(int CharDelay=0) // when GPS starts sending the data
} }
#endif #endif
#ifdef WITH_GPS_MTK #ifdef WITH_GPS_MTK
Format_String(GPS_UART_Write, "\r\n\r\n"); // apparently this is needed, otherwise the next command is missed
if(Parameters.NavRate) if(Parameters.NavRate)
{ uint8_t Len = Format_String(GPS_Cmd, "$PMTK220,"); // navigation rate { // uint8_t Len = Format_String(GPS_Cmd, "$PMTK220,"); // report rate
uint8_t Len = Format_String(GPS_Cmd, "$PMTK300,"); // fix rate
uint16_t OneSec = 1000; uint16_t OneSec = 1000;
Len += Format_UnsDec(GPS_Cmd+Len, OneSec/Parameters.NavRate); Len += Format_UnsDec(GPS_Cmd+Len, OneSec/Parameters.NavRate);
Len += Format_String(GPS_Cmd+Len, ",0,0,0,0");
Len += NMEA_AppendCheck(GPS_Cmd, Len); Len += NMEA_AppendCheck(GPS_Cmd, Len);
GPS_Cmd[Len++]='\r'; GPS_Cmd[Len++]='\r';
GPS_Cmd[Len++]='\n'; GPS_Cmd[Len++]='\n';
GPS_Cmd[Len]=0; GPS_Cmd[Len]=0;
// Format_String(CONS_UART_Write, GPS_Cmd, Len, 0); // for debug
Format_String(GPS_UART_Write, GPS_Cmd, Len, 0); Format_String(GPS_UART_Write, GPS_Cmd, Len, 0);
GPS_Status.ModeConfig=1; } GPS_Status.ModeConfig=1; }
if(Parameters.NavMode) if(Parameters.NavMode)
@ -325,6 +329,7 @@ static void GPS_BurstStart(int CharDelay=0) // when GPS starts sending the data
GPS_Cmd[Len++]='\r'; GPS_Cmd[Len++]='\r';
GPS_Cmd[Len++]='\n'; GPS_Cmd[Len++]='\n';
GPS_Cmd[Len]=0; GPS_Cmd[Len]=0;
// Format_String(CONS_UART_Write, GPS_Cmd, Len, 0); // for debug
Format_String(GPS_UART_Write, GPS_Cmd, Len, 0); Format_String(GPS_UART_Write, GPS_Cmd, Len, 0);
GPS_Status.ModeConfig=1; } GPS_Status.ModeConfig=1; }
if(Parameters.GNSS) if(Parameters.GNSS)
@ -342,6 +347,7 @@ static void GPS_BurstStart(int CharDelay=0) // when GPS starts sending the data
GPS_Cmd[Len++]='\r'; GPS_Cmd[Len++]='\r';
GPS_Cmd[Len++]='\n'; GPS_Cmd[Len++]='\n';
GPS_Cmd[Len]=0; GPS_Cmd[Len]=0;
// Format_String(CONS_UART_Write, GPS_Cmd, Len, 0); // for debug
Format_String(GPS_UART_Write, GPS_Cmd, Len, 0); } Format_String(GPS_UART_Write, GPS_Cmd, Len, 0); }
#endif #endif
} }