68 lines
1.7 KiB
C++
68 lines
1.7 KiB
C++
#include "gps.h"
|
|
#include "settings.h"
|
|
|
|
SoftwareSerial gps_begin() {
|
|
SoftwareSerial serial_gps(PIN_GPS_RX, PIN_GPS_TX);
|
|
// Initialise the software-based serial connection to the GPS device
|
|
serial_gps.begin(BAUD_GPS);
|
|
return serial_gps;
|
|
}
|
|
|
|
GPSLocation gps_fetch() {
|
|
// The serial connection to the GPS module
|
|
SoftwareSerial serial_gps = gps_begin();
|
|
// The GPS message decoder
|
|
TinyGPSPlus gps;
|
|
// The struct that will hold the result
|
|
GPSLocation result;
|
|
|
|
Serial.print(F("[gps] Working: "));
|
|
uint32_t ms_last_update = millis();
|
|
// We WILL discover our location - if it's the last thing we do!
|
|
while(true) {
|
|
if(millis() > 5000 && gps.charsProcessed() < 10) {
|
|
Serial.println(F("\n[error] GPS device init failed"));
|
|
while(true) { delay(1); }
|
|
}
|
|
|
|
// Make sure there's something to read
|
|
if(serial_gps.available() <= 0)
|
|
continue;
|
|
|
|
// If it failed, go around again
|
|
if(!gps.encode(serial_gps.read()))
|
|
continue;
|
|
|
|
// If we haven't acquired a lock yet, go around again
|
|
if(!gps.location.isValid()
|
|
#ifdef SD_DEBUG_ENABLED
|
|
|| !gps.time.isValid()
|
|
#endif
|
|
) {
|
|
// NOTE: It can take a rather long time to get a lock. Just wait patiently :-)
|
|
if(millis() - ms_last_update > 500) Serial.print(".");
|
|
ms_last_update = millis();
|
|
continue;
|
|
}
|
|
|
|
// Hooray!
|
|
Serial.println(F("ok"));
|
|
|
|
result.lat = gps.location.lat();
|
|
result.lng = gps.location.lng();
|
|
#ifdef SD_DEBUG_ENABLED
|
|
snprintf(result.time, 19, "%04d-%02d-%02d %02d:%02d:%02d",
|
|
gps.date.year(), gps.date.month(), gps.date.day(),
|
|
gps.time.hour(), gps.time.minute(), gps.time.second()
|
|
);
|
|
#endif
|
|
return result;
|
|
}
|
|
|
|
gps_end(serial_gps);
|
|
}
|
|
|
|
void gps_end(SoftwareSerial serial_gps) {
|
|
serial_gps.end();
|
|
}
|