#include <string.h>
#include <ctype.h>
#include <AFSoftSerial.h>
AFSoftSerial mySerial = AFSoftSerial(3, 2);
int ledPin = 13; // LED test pin
int byteGPS=-1;
char linea[70] = "";
char comandoGPR[7] = "$GPGGA";
char latdms[9], londms[10], latdir[1], londir[1] = "";
int latdd, londd, heading = 0;
int cont=0;
int bien=0;
int conta=0;
int indices[13];
void setup() {
pinMode(ledPin, OUTPUT); // Initialize LED pin
pinMode(rxPin, INPUT);
pinMode(txPin, OUTPUT);
Serial.begin(4800);
for (int i=0;i<70;i++){ // Initialize a buffer for received data
linea[i]=' ';
}
mySerial.begin(4800);
}
void loop() {
digitalWrite(ledPin, HIGH);
byteGPS=mySerial.read();
if (byteGPS == -1) { // See if the port is empty yet
delay(100);
} else {
linea[conta]=byteGPS; // If there is serial port data, it is put in the buffer
conta++;
if (byteGPS==13){ // If the received byte is = to 13, end of transmission
digitalWrite(ledPin, LOW);
cont=0;
bien=0;
for (int i=1;i<7;i++){ // Verifies if the received command starts with $GPR
if (linea[i]==comandoGPR[i-1]){
bien++;
}
}
if(bien==6){ // If yes, continue and process the data
for (int i=0;i<70;i++){
if (linea[i]==','){ // check for the position of the "," separator
indices[cont]=i;
cont++;
}
if (linea[i]=='*'){ // ... and the "*"
indices[12]=i;
cont++;
}
}
Serial.print(linea); // This is the important line :)
}
conta=0; // Reset the buffer
for (int i=0;i<70;i++){ //
linea[i]=' ';
}
}
}
}
Show Posts
