-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathUltimateGPS_Job.h
122 lines (94 loc) · 3.3 KB
/
UltimateGPS_Job.h
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
#ifndef ULTIMATEGPS_JOB_H
#define ULTIMATEGPS_JOB_H
#include <Adafruit_GPS.h>
#include "Job.h"
#define GPS_PRINT_TIME 1000 //ms
#define GPSSerial Serial1
class UltimateGPS_Job : public Job {
public:
Adafruit_GPS GPS;
UltimateGPS_Job() : Job(GPS_PRINT_TIME), GPS(&GPSSerial) {}
enum Outcome initialize() override {
if (!GPS.begin(9600)) {
JOB_DEBUG("Failed to open Serial to Ultimate GPS module");
return Outcome::FailureRetry;
}
// I don't believe this is conclusive
// JOB_DEBUG("Ultimate GPS Found!");
GPS.sendCommand(PMTK_SET_NMEA_OUTPUT_RMCGGA);
GPS.sendCommand(PMTK_SET_NMEA_UPDATE_1HZ);
GPS.sendCommand(PGCMD_ANTENNA);
GPS.println(PMTK_Q_RELEASE);
return Outcome::Success;
}
bool ready() override {
return GPS.newNMEAreceived();
}
void poll() override {
char c = GPS.read();
if (this->debug && c != 0) {
Serial.print("GPS serial character: ");
Serial.println(c);
}
}
enum Outcome close() override {
// TODO
return Outcome::FailurePermanent;
}
enum Outcome execute() override {
time_t now = millis();
if (!GPS.newNMEAreceived()) {
return Outcome::Waiting;
}
if (!GPS.parse(GPS.lastNMEA())) {
return Outcome::FailureRetry;
}
if (now - last_execution_time > GPS_PRINT_TIME) {
if (this->debug) {
Serial.println("-- GPS READING --");
Serial.print("Time: ");
if (GPS.hour < 10) { Serial.print('0'); }
Serial.print(GPS.hour, DEC); Serial.print(':');
if (GPS.minute < 10) { Serial.print('0'); }
Serial.print(GPS.minute, DEC); Serial.print(':');
if (GPS.seconds < 10) { Serial.print('0'); }
Serial.print(GPS.seconds, DEC); Serial.print('.');
if (GPS.milliseconds < 10) {
Serial.print("00");
} else if (GPS.milliseconds > 9 && GPS.milliseconds < 100) {
Serial.print("0");
}
Serial.println(GPS.milliseconds);
Serial.print("Date: ");
Serial.print(GPS.day, DEC); Serial.print('/');
Serial.print(GPS.month, DEC); Serial.print("/20");
Serial.println(GPS.year, DEC);
if (GPS.fix) {
Serial.print("Fix: Found");
Serial.print(" quality: ");
Serial.println((int)GPS.fixquality);
Serial.print("Location: ");
Serial.print(GPS.latitude, 4); Serial.print(GPS.lat);
Serial.print(", ");
Serial.print(GPS.longitude, 4); Serial.println(GPS.lon);
Serial.print("Speed (knots): ");
Serial.println(GPS.speed);
Serial.print("Angle: ");
Serial.println(GPS.angle);
Serial.print("Altitude: ");
Serial.println(GPS.altitude);
} else {
Serial.println("Fix: Not Found");
}
Serial.print("Satellites: ");
Serial.println((int)GPS.satellites);
Serial.print("Antenna status: ");
Serial.println((int)GPS.antenna);
Serial.println("--------------------");\
last_execution_time = now;
}
}
return Outcome::Success;
}
};
#endif /* ULTIMATEGPS_MODULE_H */