25 lines
478 B
C
25 lines
478 B
C
|
#pragma once
|
||
|
|
|
||
|
|
#include "Wire.h"
|
||
|
|
#include <Adafruit_GPS.h>
|
||
|
|
|
||
|
|
struct GPS {
|
||
|
|
Adafruit_GPS gps;
|
||
|
|
GPS(TwoWire *theWire) {
|
||
|
|
gps = Adafruit_GPS(theWire);
|
||
|
|
gps.begin(0x10);
|
||
|
|
gps.sendCommand(PMTK_SET_NMEA_OUTPUT_RMCGGA);
|
||
|
|
|
||
|
|
gps.sendCommand(PMTK_API_SET_FIX_CTL_5HZ);
|
||
|
|
gps.sendCommand(PMTK_SET_NMEA_UPDATE_5HZ);
|
||
|
|
}
|
||
|
|
|
||
|
|
void poll() {
|
||
|
|
this->gps.read();
|
||
|
|
if (this->gps.newNMEAreceived()) {
|
||
|
|
if (!this->gps.parse(this->gps.lastNMEA()))
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
};
|