GPS-library with some changes
Dependents: GPSXbee GPSXbee_1_1 GPSXbee_1_0 GPSXbeeCamera_1_0
Fork of GPS by
GPS.cpp
- Committer:
- Deurklink
- Date:
- 2014-07-04
- Revision:
- 6:4e2a078995df
- Parent:
- 4:85068b8c3f50
File content as of revision 6:4e2a078995df:
#include "GPS.h" GPS::GPS(PinName tx, PinName rx) : time(0), hours(0), minutes(0), seconds(0), latitude(0), longitude(0), speed(0), heading(0), date(0), fixtype(0), satellites(0), altitude(0), _UltimateGps(tx, rx) { _UltimateGps.baud(9600); } int GPS::parseData() { while(1) { getData(); if(sscanf(NEMA, "GPGGA, %*f, %*f, %*c, %*f, %*c, %d, %d, %*f, %f", &fixtype, &satellites, &altitude) >=1); if(sscanf(NEMA, "GPRMC, %2d%2d%f, %c, %f, %c, %f, %c, %f, %f, %d", &hours, &minutes, &seconds, &validity, &latitude, &ns, &longitude, &ew, &speed, &heading, &date) >=1) { if(fixtype == 0) { return 0; } if(ns =='S') { latitude *= -1.0; } if(ew =='W') { longitude *= -1.0; } float degrees = trunc(latitude / 100.0f); float minutes = latitude - (degrees * 100.0f); latitude = degrees + minutes / 60.0f; degrees = trunc(longitude / 100.0f); minutes = longitude - (degrees * 100.0f); longitude = degrees + minutes / 60.0f; kph = speed*1.852; return 1; } } } float GPS::trunc(float v) { if(v < 0.0) { v*= -1.0; v = floor(v); v*=-1.0; } else { v = floor(v); } return v; } void GPS::getData() { while(_UltimateGps.getc() != '$'); for(int i=0; i<256; i++) { NEMA[i] = _UltimateGps.getc(); if(NEMA[i] == '\r') { NEMA[i] = 0; return; } } error("overflowed message limit"); } void GPS::Init() { _UltimateGps.printf("$PMTK220,1000*1F\r\n"); wait(1); _UltimateGps.printf("$PMTK314,0,1,0,1,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0*28\r\n"); wait(1); } bool GPS::readable() { if (_UltimateGps.readable()) return true; else return false; }