/
gps.cpp
293 lines (262 loc) · 9.35 KB
/
gps.cpp
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
/*
* GPS support for The Akafugu Nixie Clock
* (C) 2012 William B Phelps
*
* This program is free software; you can redistribute it and/or modify it under the
* terms of the GNU General Public License as published by the Free Software
* Foundation; either version 2 of the License, or (at your option) any later
* version.
*
* This program is distributed in the hope that it will be useful, but WITHOUT ANY
* WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A
* PARTICULAR PURPOSE. See the GNU General Public License for more details.
*
*/
#include "global.h"
#ifdef HAVE_GPS
#include <avr/interrupt.h>
#include <string.h>
#include <util/delay.h>
#include "gps.h"
#include "time.h"
#include <WireRtcLib.h>
unsigned long tGPSupdate;
// we double buffer: read into one line and leave one for the main program
volatile char gpsBuffer1[GPSBUFFERSIZE];
volatile char gpsBuffer2[GPSBUFFERSIZE];
// our index into filling the current line
volatile uint8_t gpsBufferPtr;
// pointers to the double buffers
volatile char *gpsNextBuffer;
volatile char *gpsLastBuffer;
volatile uint8_t gpsDataReady_;
extern int8_t g_gps_enabled;
extern int8_t g_TZ_hour;
extern int8_t g_TZ_minute;
int8_t g_gps_updating; // for signalling GPS update on some displays
// debugging counters
int8_t g_gps_cks_errors; // gps checksum error counter
int8_t g_gps_parse_errors; // gps parse error counter
int8_t g_gps_time_errors; // gps time error counter
int8_t g_DST_mode; // DST off, on, auto?
int8_t g_DST_offset; // DST offset in Hours
int8_t g_DST_updated; // DST update flag = allow update only once per day
//volatile uint8_t gpsEnabled = 0;
#define gpsTimeoutLimit 5 // 5 seconds until we display the "no gps" message
uint16_t gpsTimeout; // how long since we received valid GPS data?
extern WireRtcLib rtc;
void setRTCTime(time_t t)
{
tmElements_t tm;
breakTime(t, &tm);
rtc.setTime_s(tm.Hour, tm.Minute, tm.Second);
}
void GPSread(void)
{
char c = 0;
if ((g_gps_enabled) && (UCSR0A & _BV(RXC0))) {
c=UDR0; // get a byte from the port
if (c == '$') {
gpsNextBuffer[gpsBufferPtr] = 0;
gpsBufferPtr = 0;
}
if (c == '\n') { // newline marks end of sentence
gpsNextBuffer[gpsBufferPtr] = 0; // terminate string
if (gpsNextBuffer == gpsBuffer1) { // switch buffers
gpsNextBuffer = gpsBuffer2;
gpsLastBuffer = gpsBuffer1;
} else {
gpsNextBuffer = gpsBuffer1;
gpsLastBuffer = gpsBuffer2;
}
gpsBufferPtr = 0;
gpsDataReady_ = true; // signal data ready
}
gpsNextBuffer[gpsBufferPtr++] = c; // add char to current buffer, then increment index
if (gpsBufferPtr >= GPSBUFFERSIZE) { // if buffer full
gpsBufferPtr = GPSBUFFERSIZE-1; // decrement index to make room (overrun)
}
}
}
uint8_t gpsDataReady(void) {
return gpsDataReady_;
}
char *gpsNMEA(void) {
gpsDataReady_ = false;
return (char *)gpsLastBuffer;
}
uint32_t parsedecimal(char *str) {
uint32_t d = 0;
while (str[0] != 0) {
if ((str[0] > '9') || (str[0] < '0'))
return d; // no more digits
d = (d*10) + (str[0] - '0');
str++;
}
return d;
}
const char hex[17] = "0123456789ABCDEF";
uint8_t atoh(char x) {
return (strchr(hex, x) - hex);
}
uint32_t hex2i(char *str, uint8_t len) {
uint32_t d = 0;
for (uint8_t i=0; i<len; i++) {
d = (d*10) + (strchr(hex, str[i]) - hex);
}
return d;
}
// 225446 Time of fix 22:54:46 UTC
// A Navigation receiver warning A = OK, V = warning
// 4916.45,N Latitude 49 deg. 16.45 min North
// 12311.12,W Longitude 123 deg. 11.12 min West
// 000.5 Speed over ground, Knots
// 054.7 Course Made Good, True
// 191194 Date of fix 19 November 1994
// 020.3,E Magnetic variation 20.3 deg East
// *68 mandatory checksum
//$GPRMC,225446.000,A,4916.45,N,12311.12,W,000.5,054.7,191194,020.3,E*68\r\n
// 0 1 2 3 4 5 6 7
// 0123456789012345678901234567890123456789012345678901234567890123456789012
// 0 1 2 3 4 5 6 7 8 9 10 11 12
void parseGPSdata(char *gpsBuffer) {
time_t tNow;
tmElements_t tm;
uint8_t gpsCheck1, gpsCheck2; // checksums
// char gpsTime[10]; // time including fraction hhmmss.fff
char gpsFixStat; // fix status
// char gpsLat[7]; // ddmm.ff (with decimal point)
// char gpsLatH; // hemisphere
// char gpsLong[8]; // dddmm.ff (with decimal point)
// char gpsLongH; // hemisphere
// char gpsSpeed[5]; // speed over ground
// char gpsCourse[5]; // Course
// char gpsDate[6]; // Date
// char gpsMagV[5]; // Magnetic variation
// char gpsMagD; // Mag var E/W
// char gpsCKS[2]; // Checksum without asterisk
char *ptr;
uint32_t tmp;
if ( strncmp( gpsBuffer, "$GPRMC,", 7 ) == 0 ) {
//Serial.println("parseGPSData");
//Serial.println(gpsBuffer);
//beep(1000, 1);
//Calculate checksum from the received data
ptr = &gpsBuffer[1]; // start at the "G"
gpsCheck1 = 0; // init collector
/* Loop through entire string, XORing each character to the next */
while (*ptr != '*') // count all the bytes up to the asterisk
{
gpsCheck1 ^= *ptr;
ptr++;
if (ptr>(gpsBuffer+GPSBUFFERSIZE)) goto GPSerror1; // extra sanity check, can't hurt...
}
// now get the checksum from the string itself, which is in hex
gpsCheck2 = atoh(*(ptr+1)) * 16 + atoh(*(ptr+2));
if (gpsCheck1 == gpsCheck2) { // if checksums match, process the data
//beep(1000, 1);
ptr = strtok(gpsBuffer, ",*\r"); // parse $GPRMC
if (ptr == NULL) goto GPSerror1;
ptr = strtok(NULL, ",*\r"); // Time including fraction hhmmss.fff
if (ptr == NULL) goto GPSerror1;
if ((strlen(ptr) < 6) || (strlen(ptr) > 10)) goto GPSerror1; // check time length
// strncpy(gpsTime, ptr, 10); // copy time string hhmmss
tmp = parsedecimal(ptr); // parse integer portion
tm.Hour = tmp / 10000;
tm.Minute = (tmp / 100) % 100;
tm.Second = tmp % 100;
ptr = strtok(NULL, ",*\r"); // Status
if (ptr == NULL) goto GPSerror1;
gpsFixStat = ptr[0];
if (gpsFixStat == 'A') { // if data valid, parse time & date
gpsTimeout = 0; // reset gps timeout counter
ptr = strtok(NULL, ",*\r"); // Latitude including fraction
if (ptr == NULL) goto GPSerror1;
// strncpy(gpsLat, ptr, 7); // copy Latitude ddmm.ff
ptr = strtok(NULL, ",*\r"); // Latitude N/S
if (ptr == NULL) goto GPSerror1;
// gpsLatH = ptr[0];
ptr = strtok(NULL, ",*\r"); // Longitude including fraction hhmm.ff
if (ptr == NULL) goto GPSerror1;
// strncpy(gpsLong, ptr, 7);
ptr = strtok(NULL, ",*\r"); // Longitude Hemisphere
if (ptr == NULL) goto GPSerror1;
// gpsLongH = ptr[0];
ptr = strtok(NULL, ",*\r"); // Ground speed 000.5
if (ptr == NULL) goto GPSerror1;
// strncpy(gpsSpeed, ptr, 5);
ptr = strtok(NULL, ",*\r"); // Track angle (course) 054.7
if (ptr == NULL) goto GPSerror1;
// strncpy(gpsCourse, ptr, 5);
ptr = strtok(NULL, ",*\r"); // Date ddmmyy
if (ptr == NULL) goto GPSerror1;
// strncpy(gpsDate, ptr, 6);
if (strlen(ptr) != 6) goto GPSerror1; // check date length
tmp = parsedecimal(ptr);
tm.Day = tmp / 10000;
tm.Month = (tmp / 100) % 100;
tm.Year = tmp % 100;
ptr = strtok(NULL, "*\r"); // magnetic variation & dir
if (ptr == NULL) goto GPSerror1;
if (ptr == NULL) goto GPSerror1;
ptr = strtok(NULL, ",*\r"); // Checksum
if (ptr == NULL) goto GPSerror1;
// strncpy(gpsCKS, ptr, 2); // save checksum chars
tm.Year = y2kYearToTm(tm.Year); // convert yy year to (yyyy-1970) (add 30)
tNow = makeTime(&tm); // convert to time_t
if ((tGPSupdate>0) && (abs(tNow-tGPSupdate)>SECS_PER_DAY)) goto GPSerror2; // GPS time jumped more than 1 day
if ((tm.Second == 0) || ((tNow - tGPSupdate)>=60)) { // update RTC once/minute or if it's been 60 seconds
//beep(1000, 1); // debugging
g_gps_updating = true;
tGPSupdate = tNow; // remember time of this update
tNow = tNow + (long)(g_TZ_hour + g_DST_offset) * SECS_PER_HOUR; // add time zone hour offset & DST offset
if (g_TZ_hour < 0) // add or subtract time zone minute offset
tNow = tNow - (long)g_TZ_minute * SECS_PER_HOUR;
else
tNow = tNow + (long)g_TZ_minute * SECS_PER_HOUR;
setRTCTime(tNow); // set RTC from adjusted GPS time & date
}
else
g_gps_updating = false;
} // if fix status is A
} // if checksums match
else // checksums do not match
g_gps_cks_errors++; // increment error count
return;
GPSerror1:
g_gps_parse_errors++; // increment error count
goto GPSerror2a;
GPSerror2:
g_gps_time_errors++; // increment error count
GPSerror2a:
//beep(2093,1); // error signal - I'm leaving this in for now /wm
//flash_display(200); // flash display to show GPS error
strcpy(gpsBuffer, ""); // wipe GPS buffer
} // if "$GPRMC"
}
void uart_init(uint16_t BRR) {
/* setup the main UART */
UBRR0 = BRR; // set baudrate counter
UCSR0B = _BV(RXEN0) | _BV(TXEN0);
UCSR0C = _BV(USBS0) | (3<<UCSZ00);
DDRD |= _BV(PORTD1);
DDRD &= ~_BV(PORTD0);
}
void gps_init(uint8_t gps) {
switch (gps) {
case(0): // no GPS
break;
case(48):
uart_init(BRRL_4800);
break;
case(96):
uart_init(BRRL_9600);
break;
}
tGPSupdate = 0; // reset GPS last update time
gpsDataReady_ = false;
gpsBufferPtr = 0;
gpsNextBuffer = gpsBuffer1;
gpsLastBuffer = gpsBuffer2;
}
#endif // HAVE_GPS