2019-03-11 18:09:01 +01:00
|
|
|
#if(HAS_GPS)
|
2018-06-08 22:41:37 +02:00
|
|
|
|
|
|
|
#include "globals.h"
|
|
|
|
|
|
|
|
// Local logging tag
|
2019-02-27 00:52:27 +01:00
|
|
|
static const char TAG[] = __FILE__;
|
2018-06-09 17:59:59 +02:00
|
|
|
|
2018-09-20 13:23:22 +02:00
|
|
|
TinyGPSPlus gps;
|
2018-07-19 21:53:56 +02:00
|
|
|
gpsStatus_t gps_status;
|
2018-10-03 16:24:45 +02:00
|
|
|
TaskHandle_t GpsTask;
|
2018-07-19 21:53:56 +02:00
|
|
|
|
2018-11-25 16:05:30 +01:00
|
|
|
#ifdef GPS_SERIAL
|
2019-01-26 12:32:58 +01:00
|
|
|
HardwareSerial GPS_Serial(1); // use UART #1
|
2018-11-25 16:05:30 +01:00
|
|
|
#endif
|
2018-06-09 13:18:59 +02:00
|
|
|
|
2018-11-25 16:05:30 +01:00
|
|
|
// initialize and configure GPS
|
|
|
|
int gps_init(void) {
|
2018-06-12 19:48:21 +02:00
|
|
|
|
2018-11-25 16:05:30 +01:00
|
|
|
int ret = 1;
|
2018-06-12 19:48:21 +02:00
|
|
|
|
2019-02-09 13:02:38 +01:00
|
|
|
if (!gps_config()) {
|
|
|
|
ESP_LOGE(TAG, "GPS chip initializiation error");
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2018-06-12 19:48:21 +02:00
|
|
|
#if defined GPS_SERIAL
|
2018-09-20 19:36:32 +02:00
|
|
|
GPS_Serial.begin(GPS_SERIAL);
|
2018-11-25 16:05:30 +01:00
|
|
|
ESP_LOGI(TAG, "Using serial GPS");
|
2018-10-20 09:58:53 +02:00
|
|
|
#elif defined GPS_I2C
|
|
|
|
Wire.begin(GPS_I2C, 400000); // I2C connect to GPS device with 400 KHz
|
2018-09-20 17:33:52 +02:00
|
|
|
Wire.beginTransmission(GPS_ADDR);
|
2018-09-20 19:36:32 +02:00
|
|
|
Wire.write(0x00); // dummy write
|
|
|
|
ret = Wire.endTransmission(); // check if chip is seen on i2c bus
|
|
|
|
|
|
|
|
if (ret) {
|
|
|
|
ESP_LOGE(TAG,
|
|
|
|
"Quectel L76 GPS chip not found on i2c bus, bus error %d. "
|
|
|
|
"Stopping GPS-Task.",
|
|
|
|
ret);
|
2018-11-25 16:05:30 +01:00
|
|
|
ret = 0;
|
2018-09-20 19:36:32 +02:00
|
|
|
} else {
|
2018-11-25 16:05:30 +01:00
|
|
|
ESP_LOGI(TAG, "Quectel L76 GPS chip found");
|
2018-09-20 17:33:52 +02:00
|
|
|
}
|
2018-06-12 19:48:21 +02:00
|
|
|
#endif
|
|
|
|
|
2018-11-25 16:05:30 +01:00
|
|
|
return ret;
|
|
|
|
} // gps_init()
|
|
|
|
|
2019-02-09 13:02:38 +01:00
|
|
|
// detect gps chipset type and configure it with device specific settings
|
|
|
|
int gps_config() {
|
|
|
|
int rslt = 1; // success
|
|
|
|
#if defined GPS_SERIAL
|
|
|
|
|
|
|
|
/* to come */
|
|
|
|
|
|
|
|
#elif defined GPS_I2C
|
|
|
|
|
|
|
|
/* to come */
|
|
|
|
|
|
|
|
#endif
|
|
|
|
return rslt;
|
|
|
|
}
|
|
|
|
|
2018-11-25 16:05:30 +01:00
|
|
|
// read GPS data and cast to global struct
|
|
|
|
void gps_read() {
|
|
|
|
gps_status.latitude = (int32_t)(gps.location.lat() * 1e6);
|
|
|
|
gps_status.longitude = (int32_t)(gps.location.lng() * 1e6);
|
|
|
|
gps_status.satellites = (uint8_t)gps.satellites.value();
|
|
|
|
gps_status.hdop = (uint16_t)gps.hdop.value();
|
|
|
|
gps_status.altitude = (int16_t)gps.altitude.meters();
|
|
|
|
// show NMEA data in debug mode, useful for debugging GPS
|
|
|
|
ESP_LOGD(TAG, "GPS NMEA data: passed %d / failed: %d / with fix: %d",
|
|
|
|
gps.passedChecksum(), gps.failedChecksum(), gps.sentencesWithFix());
|
|
|
|
}
|
|
|
|
|
2019-01-28 23:59:52 +01:00
|
|
|
// function to fetch current time from gps
|
|
|
|
time_t get_gpstime(void) {
|
2019-02-25 20:22:03 +01:00
|
|
|
|
2019-02-27 00:52:27 +01:00
|
|
|
// set time to wait for arrive next recent NMEA time record
|
2019-03-03 17:06:36 +01:00
|
|
|
static const uint32_t gpsDelay_ms = 500;
|
2019-02-25 20:22:03 +01:00
|
|
|
|
2019-02-21 23:17:01 +01:00
|
|
|
time_t t = 0;
|
2019-02-17 22:12:14 +01:00
|
|
|
|
2019-03-06 23:21:46 +01:00
|
|
|
if ((gps.time.age() < gpsDelay_ms) && gps.time.isValid() &&
|
|
|
|
gps.date.isValid() && gps.time.isUpdated()) {
|
|
|
|
|
|
|
|
gps.time.value(); // trigger isUpdated()
|
2019-03-03 17:06:36 +01:00
|
|
|
|
2019-03-03 17:35:08 +01:00
|
|
|
ESP_LOGD(TAG, "GPS time age: %dms, is valid: %s, second: %d",
|
|
|
|
gps.time.age(),
|
|
|
|
(gps.time.isValid() && gps.date.isValid()) ? "yes" : "no",
|
|
|
|
gps.time.second());
|
2019-03-03 17:06:36 +01:00
|
|
|
|
2019-03-03 17:35:08 +01:00
|
|
|
t = tmConvert(gps.date.year(), gps.date.month(), gps.date.day(),
|
|
|
|
gps.time.hour(), gps.time.minute(), gps.time.second());
|
2019-03-02 22:56:00 +01:00
|
|
|
}
|
2019-03-02 13:32:02 +01:00
|
|
|
return timeIsValid(t);
|
2019-01-28 23:59:52 +01:00
|
|
|
} // get_gpstime()
|
|
|
|
|
2018-11-25 16:05:30 +01:00
|
|
|
// GPS serial feed FreeRTos Task
|
|
|
|
void gps_loop(void *pvParameters) {
|
|
|
|
|
|
|
|
configASSERT(((uint32_t)pvParameters) == 1); // FreeRTOS check
|
|
|
|
|
2018-06-12 19:48:21 +02:00
|
|
|
while (1) {
|
|
|
|
|
2018-11-19 00:41:15 +01:00
|
|
|
if (cfg.payloadmask && GPS_DATA) {
|
2018-06-12 19:48:21 +02:00
|
|
|
#if defined GPS_SERIAL
|
2018-09-20 19:36:32 +02:00
|
|
|
// feed GPS decoder with serial NMEA data from GPS device
|
|
|
|
while (GPS_Serial.available()) {
|
|
|
|
gps.encode(GPS_Serial.read());
|
2018-06-12 19:48:21 +02:00
|
|
|
}
|
2018-10-20 09:58:53 +02:00
|
|
|
#elif defined GPS_I2C
|
2018-09-20 19:36:32 +02:00
|
|
|
Wire.requestFrom(GPS_ADDR, 32); // caution: this is a blocking call
|
|
|
|
while (Wire.available()) {
|
|
|
|
gps.encode(Wire.read());
|
2018-12-19 12:32:25 +01:00
|
|
|
delay(2); // 2ms delay according L76 datasheet
|
2018-06-12 19:48:21 +02:00
|
|
|
}
|
2018-09-20 19:36:32 +02:00
|
|
|
#endif
|
2018-11-19 00:41:15 +01:00
|
|
|
} // if
|
2018-06-12 19:48:21 +02:00
|
|
|
|
2018-12-19 12:32:25 +01:00
|
|
|
delay(2); // yield to CPU
|
2018-06-12 19:48:21 +02:00
|
|
|
|
|
|
|
} // end of infinite loop
|
2018-06-09 19:20:34 +02:00
|
|
|
|
2018-11-25 16:35:36 +01:00
|
|
|
vTaskDelete(GpsTask); // shoud never be reached
|
2018-10-03 16:24:45 +02:00
|
|
|
|
2018-06-09 19:20:34 +02:00
|
|
|
} // gps_loop()
|
2018-06-12 19:48:21 +02:00
|
|
|
|
2018-06-08 22:41:37 +02:00
|
|
|
#endif // HAS_GPS
|