Diff: app/l86.cpp

Revision:

13:66d854ad31d8

Parent:

12:d9144f16d78b

Child:

15:b4d11baea8bc

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/app/l86.cpp	Fri Nov 24 15:20:12 2017 +0000
@@ -0,0 +1,118 @@
+#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.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.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);
+}
+