/* GPS module Copyright (C) 2018 by Xose PĂ©rez 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 3 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 General Public License along with this program. If not, see . */ #include uint32_t LatitudeBinary; uint32_t LongitudeBinary; uint16_t altitudeGps; uint8_t hdopGps; uint8_t sats; char t[32]; // used to sprintf for Serial output TinyGPSPlus _gps; HardwareSerial _serial_gps(GPS_SERIAL_NUM); void gps_time(char * buffer, uint8_t size) { snprintf(buffer, size, "%02d:%02d:%02d", _gps.time.hour(), _gps.time.minute(), _gps.time.second()); } float gps_latitude() { return _gps.location.lat(); } float gps_longitude() { return _gps.location.lng(); } float gps_altitude() { return _gps.altitude.meters(); } float gps_hdop() { return _gps.hdop.hdop(); } uint8_t gps_sats() { return _gps.satellites.value(); } void gps_setup() { _serial_gps.begin(GPS_BAUDRATE, SERIAL_8N1, GPS_RX_PIN, GPS_TX_PIN); } static void gps_loop() { while (_serial_gps.available()) { _gps.encode(_serial_gps.read()); } } #if defined(PAYLOAD_USE_FULL) // More data than PAYLOAD_USE_CAYENNE void buildPacket(uint8_t txBuffer[10]) { LatitudeBinary = ((_gps.location.lat() + 90) / 180.0) * 16777215; LongitudeBinary = ((_gps.location.lng() + 180) / 360.0) * 16777215; altitudeGps = _gps.altitude.meters(); hdopGps = _gps.hdop.value() / 10; sats = _gps.satellites.value(); sprintf(t, "Lat: %f", _gps.location.lat()); Serial.println(t); sprintf(t, "Lng: %f", _gps.location.lng()); Serial.println(t); sprintf(t, "Alt: %d", altitudeGps); Serial.println(t); sprintf(t, "Hdop: %d", hdopGps); Serial.println(t); sprintf(t, "Sats: %d", sats); Serial.println(t); txBuffer[0] = ( LatitudeBinary >> 16 ) & 0xFF; txBuffer[1] = ( LatitudeBinary >> 8 ) & 0xFF; txBuffer[2] = LatitudeBinary & 0xFF; txBuffer[3] = ( LongitudeBinary >> 16 ) & 0xFF; txBuffer[4] = ( LongitudeBinary >> 8 ) & 0xFF; txBuffer[5] = LongitudeBinary & 0xFF; txBuffer[6] = ( altitudeGps >> 8 ) & 0xFF; txBuffer[7] = altitudeGps & 0xFF; txBuffer[8] = hdopGps & 0xFF; txBuffer[9] = sats & 0xFF; } #elif defined(PAYLOAD_USE_CAYENNE) // CAYENNE DF void buildPacket(uint8_t txBuffer[11]) { sprintf(t, "Lat: %f", _gps.location.lat()); Serial.println(t); sprintf(t, "Lng: %f", _gps.location.lng()); Serial.println(t); sprintf(t, "Alt: %f", _gps.altitude.meters()); Serial.println(t); int32_t lat = _gps.location.lat() * 10000; int32_t lon = _gps.location.lng() * 10000; int32_t alt = _gps.altitude.meters() * 100; txBuffer[2] = lat >> 16; txBuffer[3] = lat >> 8; txBuffer[4] = lat; txBuffer[5] = lon >> 16; txBuffer[6] = lon >> 8; txBuffer[7] = lon; txBuffer[8] = alt >> 16; txBuffer[9] = alt >> 8; txBuffer[10] = alt; } #endif