File content as of revision 1:1427f72611a4:

#include "mbed.h"
#include "MTK3339.h"


MTK3339::MTK3339(PinName tx, PinName rx) : _serial(tx, rx)
{
    _serial.baud(9600);

    _state = StateStart;
    _sentenceMask = 0;
    _availDataType = NmeaInvalid;
    memset(&gga, 0, sizeof(GgaType));
    memset(&vtg, 0, sizeof(VtgType));
}

void MTK3339::start(void (*fptr)(void), int mask)
{
    if (fptr && mask) {
        _dataCallback.attach(fptr);
        _sentenceMask = mask;
        _serial.attach(this, &MTK3339::uartIrq, Serial::RxIrq);
    }
}

void MTK3339::stop()
{
    _dataCallback.attach(NULL);
    _sentenceMask = 0;
    _serial.attach(NULL);
}

MTK3339::NmeaSentence MTK3339::getAvailableDataType()
{
    return _availDataType;
}

double MTK3339::getLatitudeAsDegrees()
{
    if(gga.fix == 0 || gga.nsIndicator == 0) return 0;

    double l = gga.latitude;
    char ns = gga.nsIndicator;

    // convert from ddmm.mmmm to degrees only
    // 60 minutes is 1 degree

    int deg = (int)(l / 100);
    l = (l - deg*100.0) / 60.0;
    l = deg + l;
    if (ns == 'S') l = -l;

    return l;
}

double MTK3339::getLongitudeAsDegrees()
{
    if(gga.fix == 0 || gga.ewIndicator == 0) return 0;

    double l = gga.longitude;
    char ew = gga.ewIndicator;

    // convert from ddmm.mmmm to degrees only
    // 60 minutes is 1 degree

    int deg = (int)(l / 100);
    l = (l - deg*100) / 60;
    l = deg + l;
    if (ew == 'W') l = -l;

    return l;
}

void MTK3339::parseGGA(char* data, int dataLen)
{
    //http://aprs.gids.nl/nmea/#gga

    double tm = 0;

    memset(&gga, 0, sizeof(GgaType));

    char* p = data;
    int pos = 0;

    p = strchr(p, ',');
    while (p != NULL && *p != 0) {
        p++;

        switch(pos) {
            case 0: // time: hhmmss.sss
                tm = strtod(p, NULL);
                gga.hours = (int)(tm / 10000);
                gga.minutes = ((int)tm % 10000) / 100;
                gga.seconds = ((int)tm % 100);
                gga.milliseconds = (int)(tm * 1000) % 1000;
                break;
            case 1: // latitude: ddmm.mmmm
                gga.latitude = strtod(p, NULL);
                break;
            case 2: // N/S indicator (north or south)
                if (*p == 'N' || *p == 'S') {
                    gga.nsIndicator = *p;
                }
                break;
            case 3: // longitude: dddmm.mmmm
                gga.longitude = strtod(p, NULL);
                break;
            case 4: // E/W indicator (east or west)
                if (*p == 'E' || *p == 'W') {
                    gga.ewIndicator = *p;
                }
                break;
            case 5: // position indicator (1=no fix, 2=GPS fix, 3=Differential)
                gga.fix = strtol(p, NULL, 10);
                break;
            case 6: // num satellites
                gga.satellites = strtol(p, NULL, 10);
                break;
            case 7: // hdop
                gga.hdop = strtod(p, NULL);
                break;
            case 8: // altitude
                gga.altitude = strtod(p, NULL);
                break;
            case 9: // units
                // ignore units
                break;
            case 10: // geoidal separation
                gga.geoidal = strtod(p, NULL);
                break;
        }
        pos++;

        p = strchr(p, ',');
    }

}

void MTK3339::parseVTG(char* data, int dataLen)
{


    char* p = data;
    int pos = 0;

    memset(&vtg, 0, sizeof(VtgType));

    p = strchr(p, ',');
    while (p != NULL && *p != 0) {
        p++;

        switch(pos) {
            case 0: // course in degrees
                vtg.course = strtod(p, NULL);
                break;
            case 1: // Reference (T)
                break;
            case 2: // course magnetic (need customization)
                break;
            case 3: // reference (M)
                break;
            case 4: // speed in knots
                vtg.speedKnots = strtod(p, NULL);
                break;
            case 5: // units (N)
                break;
            case 6: // speed in Km/h
                vtg.speedKmHour = strtod(p, NULL);
                break;
            case 7: // units (K)
                break;
            case 8: // mode
                if (*p == 'A' || *p == 'D' || *p == 'E') {
                    vtg.mode = *p;
                }

                break;

        }

        pos++;

        p = strchr(p, ',');
    }
}


void MTK3339::parseData(char* data, int len)
{
    do {

        // verify checksum
        if (len < 3 || (len > 3 && data[len-3] != '*')) {
            // invalid data
            break;
        }
        int sum = strtol(&data[len-2], NULL, 16);
        for(int i = 1; i < len-3; i++) {
            sum ^= data[i];
        }
        if (sum != 0) {
            // invalid checksum
            break;
        }


        if (strncmp("$GPGGA", data, 6) == 0 && (_sentenceMask & NmeaGga) != 0) {
            parseGGA(data, len);
            _availDataType = NmeaGga;
            _dataCallback.call();
            _availDataType = NmeaInvalid;
        } else if (strncmp("$GPVTG", data, 6) == 0 && (_sentenceMask & NmeaVtg) != 0) {
            parseVTG(data, len);
            _availDataType = NmeaVtg;
            _dataCallback.call();
            _availDataType = NmeaInvalid;
        }


    } while(0);
}

void MTK3339::uartIrq()
{
    char d = 0;

    while(_serial.readable()) {
        d = _serial.getc();

        switch(_state) {
            case StateStart:
                if (d == '$') {
                    _buf[0] = '$';
                    _bufPos = 1;
                    _state = StateData;
                }
                break;
            case StateData:
                if (_bufPos >= MTK3339_BUF_SZ) {
                    // error
                    _state = StateStart;
                } else if (d == '\r') {

                    _buf[_bufPos] = 0;

                    parseData(_buf, _bufPos);

                    _state = StateStart;
                } else {
                    _buf[_bufPos++] = d;
                }

                break;
        }
    }
}