pohui_pohui/firmware
1
0
Fork 0
mirror of https://github.com/meshtastic/firmware.git synced 2025-06-12 08:02:04 +00:00
Code Issues Actions 5 Packages Projects Releases Wiki Activity

Add delay and debug code for GPS probe

Browse Source
This commit is contained in:
Jonathan Bennett 2023-09-02 20:35:38 -05:00
parent 1a178c7d33
commit b21368ecfa
1 changed files with 8 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
src/gps/GPS.cpp
View File

@ -58,15 +58,21 @@ GPS_RESPONSE GPS::getACK(const char *message, int waitMillis)
b = _serial_gps->read();
buffer[bytesRead] = b;
bytesRead++;
if ((bytesRead == 768) || (b == '\r')) {
if ((bytesRead == 767) || (b == '\r')) {
if (strnstr((char *)buffer, message, bytesRead) != nullptr) {
return GNSS_RESPONSE_OK;
} else {
buffer[bytesRead] = '\0';
bytesRead++;
LOG_INFO("Bytes read:%s\n", (char*) buffer);
bytesRead = 0;
}
}
}
}
buffer[bytesRead] = '\0';
bytesRead++;
LOG_INFO("Bytes read:%s\n", (char*) buffer);
return GNSS_RESPONSE_NONE;
}
@ -887,6 +893,7 @@ GnssModel_t GPS::probe(int serialSpeed)
#endif
memset(&info, 0, sizeof(struct uBloxGnssModelInfo));
uint8_t buffer[768] = {0};
delay(100);
// Close all NMEA sentences , Only valid for MTK platform
_serial_gps->write("$PCAS03,0,0,0,0,0,0,0,0,0,0,,,0,0*02\r\n");