File content as of revision 15:b4d11baea8bc:

#include "l86.hpp"
#include <string.h>
#include <stdio.h>
#include "mbed.h"

#ifdef DEBUGGER
RawSerial pc2(USBTX, USBRX);    // USART2
#endif

/* Parse NMEA RMC sentence into RMC data struct */
RMC_data Parse_RMC_sentence(char RMC_sentence[MAX_NMEA_LENGTH]){
    const char delimeter[2] = ",";
    char *token = "";
    int i = 0;
    char temp[11][12];          /* [11][12]: 11 strings, of length 12 */
    RMC_data RMC_parsed;
    
    strcpy(RMC_parsed.Message, RMC_sentence);
    
    //Seperated Message
    /* get the first token */
   token = strtok(RMC_sentence, delimeter);
   
   /* walk through other tokens */
   while( token != NULL ) 
   {
         strcpy(temp[i],token);
         i++;
     token = strtok(NULL, delimeter);
   }
     
    //Copy the message into its individual components
    strcpy(RMC_parsed.Message_ID,temp[0]);
    strcpy(RMC_parsed.UTC_Time,temp[1]);
    strcpy(RMC_parsed.Status,temp[2]);
    if(strcmp(RMC_parsed.Status,"A") == 0){
        strcpy(RMC_parsed.Latitude,temp[3]);
        strcpy(RMC_parsed.N_S_Indicator,temp[4]);
        strcpy(RMC_parsed.Longitude,temp[5]);
        strcpy(RMC_parsed.E_W_Indicator,temp[6]);
        strcpy(RMC_parsed.Speed_Over_Ground,temp[7]);
        strcpy(RMC_parsed.Course_Over_Ground,temp[8]);
        strcpy(RMC_parsed.Date,temp[9]);
        strcpy(RMC_parsed.Mode,temp[10]);
    }
    return RMC_parsed;
}

// Use GPS data parse function? // parses into data formats that will be sent over LoRa

/* Print RMC_data struct to PC USART for debugging */
void Print_RMC_data(RMC_data *RMC_data_print){
    pc2.printf("RMC_Message: %s",RMC_data_print->Message);
    /*pc2.printf("UTC_Time: %s\r\n",RMC_data_print->UTC_Time);
    pc2.printf("Status: %s\r\n",RMC_data_print->Status);
    if(strcmp(RMC_data_print->Status,"A") == 0){
        pc2.printf("Latitude: %s\r\n",RMC_data_print->Latitude);
        pc2.printf("N/S: %s\r\n",RMC_data_print->N_S_Indicator);
        pc2.printf("Longitude: %s\r\n",RMC_data_print->Longitude);
        pc2.printf("E/W: %s\r\n",RMC_data_print->E_W_Indicator);
        pc2.printf("Speed: %s\r\n",RMC_data_print->Speed_Over_Ground);
        pc2.printf("Course: %s\r\n",RMC_data_print->Course_Over_Ground);
        pc2.printf("Date: %s\r\n",RMC_data_print->Date);
        pc2.printf("Mode: %s\r\n",RMC_data_print->Mode);
    }*/
}

/* Parse RMC_data struct into GPS data struct ready for sending over LoRa */
GPS_data Parse_RMC_data(RMC_data RMC_parsed){
    GPS_data GPS_parsed;
    char tempLat[11]="0";
    char tempLong[12]="0";
    if(strcmp(RMC_parsed.Status,"A") == 0){
        strcpy(GPS_parsed.UTC_Time,RMC_parsed.UTC_Time);
        if (strcmp(RMC_parsed.N_S_Indicator, "N") == 0){
            tempLat[0] = '+';
        }
        else{
            tempLat[0] = '-';
        }
        strcat(tempLat, RMC_parsed.Latitude);
        strcpy(GPS_parsed.Latitude,tempLat);
        if (strcmp(RMC_parsed.E_W_Indicator, "E") == 0){
            tempLong[0] = '+';
        }
        else{
            tempLong[0] = '-';
        }
        strcat(tempLong, RMC_parsed.Longitude);
        strcpy(GPS_parsed.Longitude, tempLong);
        strcpy(GPS_parsed.Speed_Over_Ground,RMC_parsed.Speed_Over_Ground);
        strcpy(GPS_parsed.Course_Over_Ground,RMC_parsed.Course_Over_Ground);
        // strcpy(GPS_parsed.Date,RMC_parsed.Date);
        strcpy(GPS_parsed.Node_ID, TEST_NODE_ID);
        strcpy(GPS_parsed.Node_Type, TEST_NODE_TYPE);
        strcpy(GPS_parsed.Valid,RMC_parsed.Status);
    }
    else {
        strcpy(GPS_parsed.UTC_Time, "000000.000");
        strcpy(GPS_parsed.Latitude,"+0000.0000");
        strcpy(GPS_parsed.Longitude,"+00000.0000");
        strcpy(GPS_parsed.Speed_Over_Ground,"0.00");
        strcpy(GPS_parsed.Course_Over_Ground,"000.00");          
        strcpy(GPS_parsed.Node_ID, TEST_NODE_ID);
        strcpy(GPS_parsed.Node_Type, TEST_NODE_TYPE);
        // strcpy(GPS_parsed.Date,"000000");
        strcpy(GPS_parsed.Valid,RMC_parsed.Status);
    }
    return GPS_parsed;
}

/* Print GPS_data struct to PC USART for debugging */
void Print_GPS_data(GPS_data GPS_data_print){
    pc2.printf("UTC_Time: %s\r\n",GPS_data_print.UTC_Time);
    pc2.printf("Status: %s\r\n",GPS_data_print.Valid);
    pc2.printf("Latitude: %s\r\n",GPS_data_print.Latitude);
    pc2.printf("Longitude: %s\r\n",GPS_data_print.Longitude);
    pc2.printf("Speed: %s\r\n",GPS_data_print.Speed_Over_Ground);
    pc2.printf("Course: %s\r\n",GPS_data_print.Course_Over_Ground);
    // pc2.printf("Date: %s\r\n",GPS_data_print.Date);
}