00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022 #ifndef WIN32
00023 #include <avr/io.h>
00024 #include <avr/signal.h>
00025 #include <avr/interrupt.h>
00026 #include <avr/progmem.h>
00027 #include <string.h>
00028 #endif
00029
00030 #include "global.h"
00031 #include "buffer.h"
00032 #include "rprintf.h"
00033 #include "uart2.h"
00034 #include "gps.h"
00035
00036 #include "nmea.h"
00037
00038
00039
00040
00041 extern GpsInfoType GpsInfo;
00042 #define BUFFERSIZE 80
00043 u08 NmeaPacket[BUFFERSIZE];
00044 u08 debug;
00045
00046 void nmeaInit(void)
00047 {
00048 debug = 1;
00049 }
00050
00051 u08 nmeaProcess(cBuffer* rxBuffer)
00052 {
00053 u08 foundpacket = FALSE;
00054 u08 startFlag = FALSE;
00055
00056 u08 i,j;
00057
00058
00059
00060 while(rxBuffer->datalength)
00061 {
00062
00063 if(bufferGetAtIndex(rxBuffer,0) == '$')
00064 {
00065
00066 startFlag = TRUE;
00067
00068 break;
00069 }
00070 else
00071 bufferGetFromFront(rxBuffer);
00072 }
00073
00074
00075 if(startFlag)
00076 {
00077 for(i=1; i<(rxBuffer->datalength)-1; i++)
00078 {
00079
00080 if((bufferGetAtIndex(rxBuffer,i) == '\r') && (bufferGetAtIndex(rxBuffer,i+1) == '\n'))
00081 {
00082
00083
00084 bufferGetFromFront(rxBuffer);
00085
00086 for(j=0; j<(i-1); j++)
00087 NmeaPacket[j] = bufferGetFromFront(rxBuffer);
00088
00089 bufferGetFromFront(rxBuffer);
00090 bufferGetFromFront(rxBuffer);
00091
00092 if(debug)
00093 {
00094 rprintf("Rx NMEA packet type: ");
00095 rprintfStrLen(NmeaPacket, 0, 5);
00096 rprintfCRLF();
00097 rprintfStrLen(NmeaPacket, 6, (i-1)-6);
00098 rprintfCRLF();
00099 }
00100
00101
00102 foundpacket = TRUE;
00103 break;
00104 }
00105 }
00106 }
00107
00108 if(foundpacket)
00109 {
00110
00111 if(strncmp(NmeaPacket, "GPGGA", 5))
00112 nmeaProcessGPGGA(NmeaPacket);
00113 else if(strncmp(NmeaPacket, "GPVTG", 5))
00114 nmeaProcessGPVTG(NmeaPacket);
00115 }
00116 return foundpacket;
00117 }
00118
00119 void nmeaProcessGPGGA(u08* packet)
00120 {
00121 PORTC = ~(1<<0);
00122
00123 }
00124
00125 void nmeaProcessGPVTG(u08* packet)
00126 {
00127 PORTC = ~(1<<1);
00128 }
00129