mirror of
https://github.com/MarekZegare4/MeshCore-Solo.git
synced 2026-11-02 10:51:57 +00:00
feat: add waitFor() and drain() to LocationProvider to support sending commands to GPS
This commit is contained in:
@@ -17,6 +17,8 @@ public:
|
|||||||
virtual bool isValid() = 0;
|
virtual bool isValid() = 0;
|
||||||
virtual long getTimestamp() = 0;
|
virtual long getTimestamp() = 0;
|
||||||
virtual void sendSentence(const char * sentence);
|
virtual void sendSentence(const char * sentence);
|
||||||
|
virtual bool waitFor(const char* prefix, uint32_t timeout_ms) { return false; }
|
||||||
|
virtual void drain() { }
|
||||||
virtual void reset() = 0;
|
virtual void reset() = 0;
|
||||||
virtual void begin() = 0;
|
virtual void begin() = 0;
|
||||||
virtual void stop() = 0;
|
virtual void stop() = 0;
|
||||||
|
|||||||
@@ -129,10 +129,31 @@ public :
|
|||||||
return dt.unixtime();
|
return dt.unixtime();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void drain() { while (_gps_serial->available()) _gps_serial->read(); }
|
||||||
|
|
||||||
|
const char* getSentence() const { return nmea.getSentence(); }
|
||||||
|
|
||||||
void sendSentence(const char *sentence) override {
|
void sendSentence(const char *sentence) override {
|
||||||
nmea.sendSentence(*_gps_serial, sentence);
|
nmea.sendSentence(*_gps_serial, sentence);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
bool waitFor(const char* prefix, uint32_t timeout_ms) {
|
||||||
|
size_t plen = strlen(prefix);
|
||||||
|
uint32_t timeout = millis() + timeout_ms;
|
||||||
|
while ((int32_t)(millis() - timeout) < 0) {
|
||||||
|
if (_gps_serial->available()) {
|
||||||
|
char c = _gps_serial->read();
|
||||||
|
#ifdef GPS_NMEA_DEBUG
|
||||||
|
Serial.print(c);
|
||||||
|
#endif
|
||||||
|
if (nmea.process(c) && strncmp(nmea.getSentence(), prefix, plen) == 0) return true;
|
||||||
|
} else {
|
||||||
|
yield();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
|
||||||
void loop() override {
|
void loop() override {
|
||||||
|
|
||||||
while (_gps_serial->available()) {
|
while (_gps_serial->available()) {
|
||||||
|
|||||||
Reference in New Issue
Block a user