ESP32-PaxCounter/src/gpsread.cpp

130 lines
3.2 KiB
C++
Raw Normal View History

2018-06-08 22:41:37 +02:00
#ifdef HAS_GPS
#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
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-11-25 16:05:30 +01:00
int ret = 1;
2019-02-09 13:02:38 +01:00
if (!gps_config()) {
ESP_LOGE(TAG, "GPS chip initializiation error");
return 0;
}
#if defined GPS_SERIAL
GPS_Serial.begin(GPS_SERIAL);
2018-11-25 16:05:30 +01:00
ESP_LOGI(TAG, "Using serial GPS");
#elif defined GPS_I2C
Wire.begin(GPS_I2C, 400000); // I2C connect to GPS device with 400 KHz
Wire.beginTransmission(GPS_ADDR);
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;
} else {
2018-11-25 16:05:30 +01:00
ESP_LOGI(TAG, "Quectel L76 GPS chip found");
}
#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-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-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
while (1) {
2018-11-19 00:41:15 +01:00
if (cfg.payloadmask && GPS_DATA) {
#if defined GPS_SERIAL
// feed GPS decoder with serial NMEA data from GPS device
while (GPS_Serial.available()) {
gps.encode(GPS_Serial.read());
}
#elif defined GPS_I2C
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
}
#endif
2018-11-19 00:41:15 +01:00
} // if
2018-12-19 12:32:25 +01:00
delay(2); // yield to CPU
} // 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-08 22:41:37 +02:00
#endif // HAS_GPS