/******************************************************************************* Copyright(c) 2017 Jasem Mutlaq. All rights reserved. INDI GPS NMEA Driver This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU Library General Public License along with this library; see the file COPYING.LIB. If not, write to the Free Software Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. The full GNU General Public License is included in this distribution in the file called LICENSE. *******************************************************************************/ #include "gpsnmea_driver.h" #include "minmea.h" #include "config.h" #include #include #include #include #include #include #include #include #include #include #define MAX_NMEA_PARSES 50 // Read 50 streams before giving up #define MAX_TIMEOUT_COUNT 5 // Maximum timeout before auto-connect // We declare an auto pointer to GPSD. static std::unique_ptr gpsnema(new GPSNMEA()); GPSNMEA::GPSNMEA() { setVersion(GPSNMEA_VERSION_MAJOR, GPSNMEA_VERSION_MINOR); } const char *GPSNMEA::getDefaultName() { return "GPS NMEA"; } bool GPSNMEA::initProperties() { // We init parent properties first INDI::GPS::initProperties(); IUFillText(&GPSstatusT[0], "GPS_FIX", "Fix Mode", nullptr); IUFillTextVector(&GPSstatusTP, GPSstatusT, 1, getDeviceName(), "GPS_STATUS", "GPS Status", MAIN_CONTROL_TAB, IP_RO, 60, IPS_IDLE); tcpConnection = new Connection::TCP(this); tcpConnection->setDefaultHost("192.168.1.1"); tcpConnection->setDefaultPort(50000); tcpConnection->registerHandshake([&]() { PortFD = tcpConnection->getPortFD(); return isNMEA(); }); registerConnection(tcpConnection); addDebugControl(); setDriverInterface(GPS_INTERFACE | AUX_INTERFACE); return true; } bool GPSNMEA::updateProperties() { // Call parent update properties first INDI::GPS::updateProperties(); if (isConnected()) { defineProperty(&GPSstatusTP); pthread_create(&nmeaThread, nullptr, &GPSNMEA::parseNMEAHelper, this); } else { // We're disconnected deleteProperty(GPSstatusTP.name); } return true; } IPState GPSNMEA::updateGPS() { IPState rc = IPS_BUSY; pthread_mutex_lock(&lock); if (locationPending == false && timePending == false) { rc = IPS_OK; locationPending = true; timePending = true; } pthread_mutex_unlock(&lock); return rc; } bool GPSNMEA::isNMEA() { char line[MINMEA_MAX_LENGTH]; int bytes_read = 0; int tty_rc = tty_nread_section(PortFD, line, MINMEA_MAX_LENGTH, 0xA, 3, &bytes_read); if (tty_rc < 0) { LOGF_ERROR("Error getting device readings: %s", strerror(errno)); return false; } line[bytes_read] = '\0'; return (minmea_sentence_id(line, false) != MINMEA_INVALID); } bool GPSNMEA::setSystemTime(time_t& raw_time) { #ifdef __linux__ #if defined(__GNU_LIBRARY__) #if (__GLIBC__ >= 2) && (__GLIBC_MINOR__ > 30) timespec sTime = {}; sTime.tv_sec = raw_time; clock_settime(CLOCK_REALTIME, &sTime); #else stime(&raw_time); #endif #else stime(&raw_time); #endif return true; #else (void)raw_time; return false; #endif } void* GPSNMEA::parseNMEAHelper(void *obj) { static_cast(obj)->parseNEMA(); return nullptr; } void GPSNMEA::parseNEMA() { static char ts[32] = {0}; char line[MINMEA_MAX_LENGTH]; while (isConnected()) { int bytes_read = 0; int tty_rc = tty_nread_section(PortFD, line, MINMEA_MAX_LENGTH, 0xA, 3, &bytes_read); if (tty_rc < 0) { if (tty_rc == TTY_OVERFLOW) { LOG_WARN("Overflow detected. Possible remote GPS disconnection. Disconnecting driver..."); INDI::GPS::setConnected(false); updateProperties(); break; } else { char errmsg[MAXRBUF]; tty_error_msg(tty_rc, errmsg, MAXRBUF); if (tty_rc == TTY_TIME_OUT || errno == ECONNREFUSED) { if (errno == ECONNREFUSED) { // sleep for 10 seconds tcpConnection->Disconnect(); usleep(10 * 1e6); tcpConnection->Connect(); PortFD = tcpConnection->getPortFD(); } else if (timeoutCounter++ > MAX_TIMEOUT_COUNT) { LOG_WARN("Timeout limit reached, reconnecting..."); tcpConnection->Disconnect(); // sleep for 5 seconds usleep(5 * 1e6); tcpConnection->Connect(); PortFD = tcpConnection->getPortFD(); timeoutCounter = 0; } } continue; } } line[bytes_read] = '\0'; LOGF_DEBUG("%s", line); switch (minmea_sentence_id(line, false)) { case MINMEA_SENTENCE_RMC: { struct minmea_sentence_rmc frame; if (minmea_parse_rmc(&frame, line)) { if (frame.valid) { LocationN[LOCATION_LATITUDE].value = minmea_tocoord(&frame.latitude); LocationN[LOCATION_LONGITUDE].value = minmea_tocoord(&frame.longitude); if (LocationN[LOCATION_LONGITUDE].value < 0) LocationN[LOCATION_LONGITUDE].value += 360; struct timespec timesp; time_t raw_time; struct tm *utc, *local; if (minmea_gettime(×p, &frame.date, &frame.time) == -1) break; raw_time = timesp.tv_sec; utc = gmtime(&raw_time); strftime(ts, 32, "%Y-%m-%dT%H:%M:%S", utc); IUSaveText(&TimeT[0], ts); setSystemTime(raw_time); local = localtime(&raw_time); snprintf(ts, 32, "%4.2f", (local->tm_gmtoff / 3600.0)); IUSaveText(&TimeT[1], ts); pthread_mutex_lock(&lock); locationPending = false; timePending = false; LOG_DEBUG("Threaded Location and Time updates complete."); pthread_mutex_unlock(&lock); } } else { LOG_DEBUG("$xxRMC sentence is not parsed"); } } break; case MINMEA_SENTENCE_GGA: { struct minmea_sentence_gga frame; if (minmea_parse_gga(&frame, line)) { if (frame.fix_quality == 1) { LocationN[LOCATION_LATITUDE].value = minmea_tocoord(&frame.latitude); LocationN[LOCATION_LONGITUDE].value = minmea_tocoord(&frame.longitude); if (LocationN[LOCATION_LONGITUDE].value < 0) LocationN[LOCATION_LONGITUDE].value += 360; LocationN[LOCATION_ELEVATION].value = minmea_tofloat(&frame.altitude); struct timespec timesp; time_t raw_time; struct tm *utc, *local; minmea_date gmt_date; time(&raw_time); utc = gmtime(&raw_time); gmt_date.day = utc->tm_mday; gmt_date.month = utc->tm_mon + 1; gmt_date.year = utc->tm_year; minmea_gettime(×p, &gmt_date, &frame.time); raw_time = timesp.tv_sec; utc = gmtime(&raw_time); strftime(ts, 32, "%Y-%m-%dT%H:%M:%S", utc); IUSaveText(&TimeT[0], ts); setSystemTime(raw_time); local = localtime(&raw_time); snprintf(ts, 32, "%4.2f", (local->tm_gmtoff / 3600.0)); IUSaveText(&TimeT[1], ts); pthread_mutex_lock(&lock); timePending = false; locationPending = false; LOG_DEBUG("Threaded Location and Time updates complete."); pthread_mutex_unlock(&lock); } } else { LOG_DEBUG("$xxGGA sentence is not parsed"); } } break; case MINMEA_SENTENCE_GSA: { struct minmea_sentence_gsa frame; if (minmea_parse_gsa(&frame, line)) { if (frame.fix_type == 1) { GPSstatusTP.s = IPS_BUSY; IUSaveText(&GPSstatusT[0], "NO FIX"); } else if (frame.fix_type == 2) { GPSstatusTP.s = IPS_OK; IUSaveText(&GPSstatusT[0], "2D FIX"); } else if (frame.fix_type == 3) { GPSstatusTP.s = IPS_OK; IUSaveText(&GPSstatusT[0], "3D FIX"); } IDSetText(&GPSstatusTP, nullptr); } else { LOG_DEBUG("$xxGSA sentence is not parsed."); } } break; case MINMEA_SENTENCE_ZDA: { struct minmea_sentence_zda frame; if (minmea_parse_zda(&frame, line)) { LOGF_DEBUG("$xxZDA: %d:%d:%d %02d.%02d.%d UTC%+03d:%02d", frame.time.hours, frame.time.minutes, frame.time.seconds, frame.date.day, frame.date.month, frame.date.year, frame.hour_offset, frame.minute_offset); struct timespec timesp; time_t raw_time; struct tm *utc, *local; minmea_gettime(×p, &frame.date, &frame.time); raw_time = timesp.tv_sec; utc = gmtime(&raw_time); strftime(ts, 32, "%Y-%m-%dT%H:%M:%S", utc); IUSaveText(&TimeT[0], ts); setSystemTime(raw_time); local = localtime(&raw_time); snprintf(ts, 32, "%4.2f", (local->tm_gmtoff / 3600.0)); IUSaveText(&TimeT[1], ts); pthread_mutex_lock(&lock); timePending = false; LOG_DEBUG("Threaded Time update complete."); pthread_mutex_unlock(&lock); } else { LOG_DEBUG("$xxZDA sentence is not parsed"); } } break; case MINMEA_INVALID: { //LOG_WARN("$xxxxx sentence is not valid"); } break; default: { LOG_DEBUG("$xxxxx sentence is not parsed"); } break; } } pthread_exit(nullptr); }