File content as of revision 6:94e2037a8bc8:

#include "GPS.h"
GPS::GPS(PinName tx, PinName rx) : _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, %2d%2d%2d", &hours, &minutes, &seconds, &validity, &latitude, &ns, &longitude, &ew, &speed, &heading, &day, &month, &year) >=1) {
            if(fixtype == 0) {
                return 0;
            }
            year += 2000;
            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;
            if(fixtype == 1) {
                fix = "Positive";
            }
            if(fixtype == 2) {
                fix = "Differential";
            }
            if(heading > 0.0f && heading < 45.0f) {
                cardinal = "NNE";
            }
            if(heading == 45.0f) {
                cardinal = "NE";
            }
            if(heading > 45.0f && heading < 90.0f) {
                cardinal = "ENE";
            }
            if(heading == 90.0f) {
                cardinal = "E";
            }
            if(heading > 90.0f && heading < 135.0f) {
                cardinal = "ESE";
            }
            if(heading == 135.0f) {
                cardinal = "SE";
            }
            if(heading > 135.0f && heading < 180.0f) {
                cardinal = "SSE";
            }
            if(heading == 180.0f) {
                cardinal = "S";
            }
            if(heading > 180.0f && heading < 225.0f) {
                cardinal = "SSW";
            }
            if(heading == 225.0f) {
                cardinal = "SW";
            }
            if(heading > 225.0f && heading < 270.0f) {
                cardinal = "WSW";
            }
            if(heading == 270.0f) {
                cardinal = "W";
            }
            if(heading > 270.0f && heading < 315.0f) {
                cardinal = "WNW";
            }
            if(heading == 315.0f) {
                cardinal = "NW";
            }
            if(heading > 315.0f && heading < 360.0f) {
                cardinal = "NNW";
            }
            if(heading == 360.0f || heading == 0.0f) {
                cardinal = "N";
            }
            kph = speed*1.852f;
            return 1;
        }
    }
}


float GPS::trunc(float v)
{
    if(v < 0.0f) {
        v*= -1.0f;
        v = floor(v);
        v*=-1.0f;
    } 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()
{
    wait(1);
    _UltimateGps.printf("$PMTK220,200*2C\r\n");
    wait(0.2);
    _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);
}