File content as of revision 16:174daf81eea0:

#include "mbed.h"
#include "GMS6_CR6.h"

GMS6_CR6::GMS6_CR6(Serial* ps, Serial* pc): p_port(ps), p_pc(pc) {
    p_port->baud(4800);
    pointer = 0;
    INT_flag = 0;
    p_port->attach(this, &GMS6_CR6::INT_Rx, Serial::RxIrq);
}

GMS6_CR6::~GMS6_CR6() {
    p_port = NULL;
}

void GMS6_CR6::read() {
    while(INT_flag);
    int ret = sscanf(buff2, "$GPGGA,%f,%f,%c,%f,%c,%d,%d", 
                &time, &raw_latitude, &lat_hem, &raw_longitude, &lng_hem, &mode, &Ns);
    if(!ret) {
        p_pc->printf("sscanf Error\r\n");
        return;
    }
    
    int deg_lat = (int)raw_latitude / 100;
    float min_lat = (raw_latitude - (float)(deg_lat*100)) / 60.0f;
    latitude = (float)deg_lat + min_lat;
    
    int deg_lng = (int)raw_longitude / 100;
    float min_lng = (raw_longitude - (float)(deg_lng*100)) / 60.0f;
    longitude = (float)deg_lng + min_lng;
    
    
}

void GMS6_CR6::INT_Rx() {
    char *sp;
    buff1[pointer] = p_port->getc();
    
    if(buff1[pointer] != '\r') {
        if(pointer<(BuffSize-1)){
            pointer = pointer+1;
        }
    } else {
        if((sp=strstr(buff1, "$GPGGA")) != NULL) {
            buff1[pointer] = '\0';
            INT_flag = 1;
            strcpy(buff2, sp);
            INT_flag = 0;
        }
        pointer = 0;
    }
}