Have to test parsing, but seems OK
This commit is contained in:
Ladyada
parent
05aefd5d84
commit
b05dacafad
319
Adafruit_GPS.cpp
319
Adafruit_GPS.cpp
|
|
@ -0,0 +1,319 @@
|
|||
/***********************************
|
||||
This is a our GPS library
|
||||
|
||||
Adafruit invests time and resources providing this open source code,
|
||||
please support Adafruit and open-source hardware by purchasing
|
||||
products from Adafruit!
|
||||
|
||||
Written by Limor Fried/Ladyada for Adafruit Industries.
|
||||
BSD license, check license.txt for more information
|
||||
All text above must be included in any redistribution
|
||||
****************************************/
|
||||
|
||||
#include <Adafruit_GPS.h>
|
||||
|
||||
|
||||
|
||||
Adafruit_GPS GPS;
|
||||
|
||||
// we double buffer: read one line in and leave one for the main program
|
||||
volatile char line1[MAXLINELENGTH];
|
||||
volatile char line2[MAXLINELENGTH];
|
||||
// our index into filling the current line
|
||||
volatile uint8_t lineidx=0;
|
||||
// pointers to the double buffers
|
||||
volatile char *currentline;
|
||||
volatile char *lastline;
|
||||
volatile boolean recvdflag;
|
||||
|
||||
|
||||
// a ticker to divide out 1ms rate to 10ms period instead
|
||||
static volatile uint8_t compA_Ticker = 0;
|
||||
#define compA_MAX 1
|
||||
|
||||
SIGNAL(TIMER0_COMPA_vect) {
|
||||
compA_Ticker++;
|
||||
if (compA_Ticker < compA_MAX)
|
||||
return;
|
||||
compA_Ticker = 0;
|
||||
|
||||
GPS.read();
|
||||
}
|
||||
|
||||
boolean Adafruit_GPS::parse(char *nmea) {
|
||||
|
||||
// look for a few common sentences
|
||||
|
||||
if (strstr(nmea, "$GPGGA")) {
|
||||
// found GGA
|
||||
char *p = nmea;
|
||||
|
||||
// get time
|
||||
p = strchr(p, ',')+1;
|
||||
float timef = atof(p);
|
||||
uint32_t time = timef;
|
||||
hour = time / 10000;
|
||||
minute = (time % 10000) / 100;
|
||||
seconds = (time % 100);
|
||||
|
||||
milliseconds = fmod(timef, 1.0) * 1000;
|
||||
p = strchr(p, ',')+1;
|
||||
|
||||
// parse out latitude
|
||||
p = strchr(p, ',')+1;
|
||||
latitude = atof(p);
|
||||
|
||||
p = strchr(p, ',')+1;
|
||||
if (p[0] == 'N') lat = 'N';
|
||||
else if (p[0] == 'S') lat = 'S';
|
||||
else if (p[0] == ',') lat = 0;
|
||||
else return false;
|
||||
|
||||
// parse out longitude
|
||||
p = strchr(p, ',')+1;
|
||||
longitude = atof(p);
|
||||
|
||||
p = strchr(p, ',')+1;
|
||||
if (p[0] == 'W') lon = 'W';
|
||||
else if (p[0] == 'E') lon = 'E';
|
||||
else if (p[0] == ',') lon = 0;
|
||||
else return false;
|
||||
|
||||
p = strchr(p, ',')+1;
|
||||
fixquality = atoi(p);
|
||||
|
||||
p = strchr(p, ',')+1;
|
||||
satellites = atoi(p);
|
||||
|
||||
p = strchr(p, ',')+1;
|
||||
HDOP = atof(p);
|
||||
|
||||
p = strchr(p, ',')+1;
|
||||
altitude = atof(p);
|
||||
p = strchr(p, ',')+1;
|
||||
p = strchr(p, ',')+1;
|
||||
geoidheight = atof(p);
|
||||
return true;
|
||||
}
|
||||
if (strstr(nmea, "$GPRMC")) {
|
||||
// found RMC
|
||||
char *p = nmea;
|
||||
|
||||
// get time
|
||||
p = strchr(p, ',')+1;
|
||||
float timef = atof(p);
|
||||
uint32_t time = timef;
|
||||
hour = time / 10000;
|
||||
minute = (time % 10000) / 100;
|
||||
seconds = (time % 100);
|
||||
|
||||
milliseconds = fmod(timef, 1.0) * 1000;
|
||||
|
||||
p = strchr(p, ',')+1;
|
||||
if (p[0] == 'A')
|
||||
fix = true;
|
||||
else if (p[0] == 'V')
|
||||
fix = false;
|
||||
else
|
||||
return false;
|
||||
|
||||
// parse out latitude
|
||||
p = strchr(p, ',')+1;
|
||||
latitude = atof(p);
|
||||
|
||||
p = strchr(p, ',')+1;
|
||||
if (p[0] == 'N') lat = 'N';
|
||||
else if (p[0] == 'S') lat = 'S';
|
||||
else if (p[0] == ',') lat = 0;
|
||||
else return false;
|
||||
|
||||
// parse out longitude
|
||||
p = strchr(p, ',')+1;
|
||||
longitude = atof(p);
|
||||
|
||||
p = strchr(p, ',')+1;
|
||||
if (p[0] == 'W') lon = 'W';
|
||||
else if (p[0] == 'E') lon = 'E';
|
||||
else if (p[0] == ',') lon = 0;
|
||||
else return false;
|
||||
|
||||
// speed
|
||||
p = strchr(p, ',')+1;
|
||||
speed = atof(p);
|
||||
|
||||
// angle
|
||||
p = strchr(p, ',')+1;
|
||||
angle = atof(p);
|
||||
|
||||
p = strchr(p, ',')+1;
|
||||
uint32_t fulldate = atof(p);
|
||||
day = fulldate / 10000;
|
||||
month = (fulldate % 10000) / 100;
|
||||
year = (fulldate % 100);
|
||||
|
||||
// we dont parse the remaining, yet!
|
||||
return true;
|
||||
}
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
void Adafruit_GPS::read(void) {
|
||||
if (paused)
|
||||
return;
|
||||
|
||||
|
||||
if (gpsSwSerial->available()) {
|
||||
char c = gpsSwSerial->read();
|
||||
|
||||
//Serial.print(c);
|
||||
|
||||
if (c == '$') {
|
||||
currentline[lineidx] = 0;
|
||||
lineidx = 0;
|
||||
}
|
||||
if (c == '\n') {
|
||||
currentline[lineidx] = 0;
|
||||
|
||||
if (currentline == line1) {
|
||||
currentline = line2;
|
||||
lastline = line1;
|
||||
} else {
|
||||
currentline = line1;
|
||||
lastline = line2;
|
||||
}
|
||||
/*
|
||||
Serial.println("----");
|
||||
Serial.println((char *)lastline);
|
||||
Serial.println("----");
|
||||
*/
|
||||
// do checksum check
|
||||
|
||||
// first look if we even have one
|
||||
if (lastline[lineidx-4] == '*') {
|
||||
uint16_t sum = parseHex(lastline[lineidx-3]) * 16;
|
||||
sum += parseHex(lastline[lineidx-2]);
|
||||
|
||||
// check checksum
|
||||
for (uint8_t i=1; i < (lineidx-4); i++) {
|
||||
sum ^= lastline[i];
|
||||
}
|
||||
if (sum == 0) {
|
||||
recvdflag = true;
|
||||
}
|
||||
}
|
||||
lineidx = 0;
|
||||
|
||||
}
|
||||
currentline[lineidx++] = c;
|
||||
if (lineidx >= MAXLINELENGTH)
|
||||
lineidx = MAXLINELENGTH-1;
|
||||
}
|
||||
}
|
||||
|
||||
Adafruit_GPS::Adafruit_GPS(void) {
|
||||
common_init(); // Set everything to common state, then...
|
||||
recvdflag = false;
|
||||
paused = false;
|
||||
lineidx = 0;
|
||||
currentline = line1;
|
||||
lastline = line2;
|
||||
interrupt = false; // do not use interrupt!
|
||||
}
|
||||
|
||||
void Adafruit_GPS::interruptReads(boolean r) {
|
||||
interrupt = r;
|
||||
if (interrupt) {
|
||||
OCR0A = 0x10;
|
||||
TIMSK0 |= _BV(OCIE0A);
|
||||
} else {
|
||||
TIMSK0 &= ~_BV(OCIE0A);
|
||||
}
|
||||
compA_Ticker = 0;
|
||||
}
|
||||
|
||||
// Constructor when using SoftwareSerial or NewSoftSerial
|
||||
#if ARDUINO >= 100
|
||||
void Adafruit_GPS::begin(SoftwareSerial *ser, uint16_t baud)
|
||||
#else
|
||||
void Adafruit_GPS::begin(NewSoftSerial *ser, uint16_t baud)
|
||||
#endif
|
||||
{
|
||||
gpsSwSerial = ser; // ...override swSerial with value passed.
|
||||
|
||||
|
||||
// 9600 NMEA is the default baud rate
|
||||
gpsSwSerial->begin(baud);
|
||||
}
|
||||
|
||||
static uint16_t parsed[25];
|
||||
|
||||
uint8_t Adafruit_GPS::parseResponse(char *response) {
|
||||
uint8_t i;
|
||||
|
||||
for (i=0; i<25; i++) parsed[i] = -1;
|
||||
|
||||
response = strstr(response, ",");
|
||||
|
||||
for (i=0; i<25; i++) {
|
||||
if (!response || (response[0] == 0) || (response[0] == '*'))
|
||||
return i;
|
||||
|
||||
response++;
|
||||
parsed[i]=0;
|
||||
while ((response[0] != ',') && (response[0] != '*') && (response[0] != 0)) {
|
||||
parsed[i] *= 10;
|
||||
char c = response[0];
|
||||
//Serial.print("("); Serial.write(c); Serial.print(")");
|
||||
if (isDigit(c))
|
||||
parsed[i] += c - '0';
|
||||
else
|
||||
parsed[i] = c;
|
||||
response++;
|
||||
}
|
||||
//Serial.print(i); Serial.print(" ");
|
||||
//Serial.println(parsed[i]);
|
||||
//Serial.println(response);
|
||||
}
|
||||
return i;
|
||||
}
|
||||
|
||||
// Initialization code used by all constructor types
|
||||
void Adafruit_GPS::common_init(void) {
|
||||
gpsSwSerial = NULL;
|
||||
gpsHwSerial = NULL;
|
||||
}
|
||||
|
||||
|
||||
void Adafruit_GPS::sendCommand(char *str) {
|
||||
gpsSwSerial->println(str);
|
||||
}
|
||||
|
||||
|
||||
|
||||
boolean Adafruit_GPS::newNMEAreceived(void) {
|
||||
return recvdflag;
|
||||
}
|
||||
|
||||
|
||||
void Adafruit_GPS::pause(boolean p) {
|
||||
paused = p;
|
||||
}
|
||||
|
||||
char *Adafruit_GPS::lastNMEA(void) {
|
||||
recvdflag = false;
|
||||
return (char *)lastline;
|
||||
}
|
||||
|
||||
|
||||
// read a Hex value and return the decimal equivalent
|
||||
uint8_t Adafruit_GPS::parseHex(char c) {
|
||||
if (c < '0')
|
||||
return 0;
|
||||
if (c <= '9')
|
||||
return c - '0';
|
||||
if (c < 'A')
|
||||
return 0;
|
||||
if (c <= 'F')
|
||||
return (c - 'A')+10;
|
||||
}
|
||||
|
|
@ -0,0 +1,96 @@
|
|||
/***********************************
|
||||
This is a our GPS library
|
||||
|
||||
Adafruit invests time and resources providing this open source code,
|
||||
please support Adafruit and open-source hardware by purchasing
|
||||
products from Adafruit!
|
||||
|
||||
Written by Limor Fried/Ladyada for Adafruit Industries.
|
||||
BSD license, check license.txt for more information
|
||||
All text above must be included in any redistribution
|
||||
****************************************/
|
||||
|
||||
#ifndef _ADAFRUIT_GPS_H
|
||||
#define _ADAFRUIT_GPS_H
|
||||
|
||||
// different commands to set the update rate from once a second (1 Hz) to 10 times a second (10Hz)
|
||||
#define PMTK_SET_NMEA_UPDATE_1HZ "$PMTK220,1000*1F"
|
||||
#define PMTK_SET_NMEA_UPDATE_5HZ "$PMTK220,200*2C"
|
||||
#define PMTK_SET_NMEA_UPDATE_10HZ "$PMTK220,100*2F"
|
||||
|
||||
// turn on only the second sentence (GPRMC)
|
||||
#define PMTK_SET_NMEA_OUTPUT_RMCONLY "$PMTK314,0,1,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0*29"
|
||||
// turn on GPRMC and GGA
|
||||
#define PMTK_SET_NMEA_OUTPUT_RMCGGA "$PMTK314,0,1,0,1,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0*28"
|
||||
// turn on ALL THE DATA
|
||||
#define PMTK_SET_NMEA_OUTPUT_ALLDATA "$PMTK314,1,1,1,1,1,1,0,0,0,0,0,0,0,0,0,0,0,0,0*28"
|
||||
|
||||
// to generate your own sentences, check out the MTK command datasheet and use a checksum calculator
|
||||
// such as the awesome http://www.hhhh.org/wiml/proj/nmeaxor.html
|
||||
|
||||
#define PMTK_LOCUS_QUERY_STATUS "$PMTK183*38"
|
||||
|
||||
|
||||
|
||||
#if ARDUINO >= 100
|
||||
#include "Arduino.h"
|
||||
#include "SoftwareSerial.h"
|
||||
#else
|
||||
#include "WProgram.h"
|
||||
#include "NewSoftSerial.h"
|
||||
#endif
|
||||
|
||||
// how long are max NMEA lines to parse?
|
||||
#define MAXLINELENGTH 100
|
||||
|
||||
class Adafruit_GPS {
|
||||
public:
|
||||
Adafruit_GPS(void); // Constructor when using SoftwareSerial
|
||||
|
||||
#if ARDUINO >= 100
|
||||
void begin(SoftwareSerial *ser, uint16_t baud); // Constructor when using SoftwareSerial
|
||||
#else
|
||||
void begin(NewSoftSerial *ser, uint16_t baud); // Constructor when using NewSoftSerial
|
||||
#endif
|
||||
void begin(HardwareSerial *ser, uint16_t baud); // Constructor when using HardwareSerial
|
||||
|
||||
char *lastNMEA(void);
|
||||
boolean newNMEAreceived();
|
||||
void common_init(void);
|
||||
void sendCommand(char *);
|
||||
void pause(boolean b);
|
||||
|
||||
boolean parseNMEA(char *response);
|
||||
uint8_t parseHex(char c);
|
||||
|
||||
void read(void);
|
||||
boolean parse(char *);
|
||||
void interruptReads(boolean r);
|
||||
|
||||
uint8_t hour, minute, seconds, year, month, day;
|
||||
uint16_t milliseconds;
|
||||
float latitude, longitude, geoidheight, altitude;
|
||||
float speed, angle, magvariation, HDOP;
|
||||
char lat, lon, mag;
|
||||
boolean fix;
|
||||
uint8_t fixquality, satellites;
|
||||
|
||||
private:
|
||||
boolean paused;
|
||||
boolean interrupt;
|
||||
|
||||
uint8_t parseResponse(char *response);
|
||||
#if ARDUINO >= 100
|
||||
SoftwareSerial *gpsSwSerial;
|
||||
#else
|
||||
NewSoftSerial *gpsSwSerial;
|
||||
#endif
|
||||
HardwareSerial *gpsHwSerial;
|
||||
};
|
||||
|
||||
|
||||
|
||||
|
||||
extern Adafruit_GPS GPS;
|
||||
|
||||
#endif
|
||||
|
|
@ -0,0 +1,11 @@
|
|||
// this sketch will allow you to bypass the Atmega chip
|
||||
// and connect the fingerprint sensor directly to the USB/Serial
|
||||
// chip converter.
|
||||
|
||||
// Red connects to +5V
|
||||
// Black connects to Ground
|
||||
// White goes to Digital 0
|
||||
// Green goes to Digital 1
|
||||
|
||||
void setup() {}
|
||||
void loop() {}
|
||||
Loading…
Reference in New Issue