-
Notifications
You must be signed in to change notification settings - Fork 14
/
read_gps.py
199 lines (174 loc) · 7.69 KB
/
read_gps.py
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
#!/usr/bin/env python3
# This file is part of HoneyPi [honey-pi.de] which is released under Creative Commons License Attribution-NonCommercial-ShareAlike 3.0 Unported (CC BY-NC-SA 3.0).
# See file LICENSE or go to http://creativecommons.org/licenses/by-nc-sa/3.0/ for full license details.
# source: https://www.haraldkreuzer.net/aktuelles/mit-gps-modul-die-uhrzeit-fuer-raspberry-pi-3-a-plus-setzen-ganz-ohne-netzwerk
import datetime as dt
import pytz
import os
from sensors.PA1010D import *
from timezonefinder import TimezoneFinder
from utilities import get_abs_timedifference
import logging
import inspect
logger = logging.getLogger('HoneyPi.gps')
from constant import local_tz
utc_tz = pytz.timezone('UTC')
gps = None
timeout=30
waitforfix=True
def init_gps(gpsSensor):
global gps
i2c_addr = 0x10
try:
if 'i2c_addr' in gpsSensor and gpsSensor["i2c_addr"] is not None:
#i2c_addr = int(i2c_addr,16)
i2c_addr = int(gpsSensor["i2c_addr"],0)
logger.debug("Initializing GPS at '" + format(i2c_addr, "x") +"'")
gps = PA1010D(i2c_addr)
# Turn off everything
gps.send_command(b'PMTK314,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0')
# Turn on the basic GGA, RMC and VTG info (what you typically want)
gps.send_command(b'PMTK314,0,1,1,1,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0')
except IOError as ex:
if str(ex) == "[Errno 121] Remote I/O error":
logger.error("Could not access GPS at I2C Adress " + format(i2c_addr, "x") + "!")
else:
logger.exception("Other IOError ")
return
except Exception as ex:
logger.exception("Exception in init_gps")
return
def get_gps_timestamp(timeout=timeout):
nema_type="RMC"
UTCtime,localtime,timestamp = None, None, None
try:
gpsfix = False
try:
gpsfix = gps.update(nema_type, timeout, waitforfix)
except TimeoutError:
logger.warning("Could not get GPS time within " + str(timeout) + " seconds!")
pass
if gpsfix:
UTCtime = gps.datetimestamp
UTCtime = pytz.utc.localize(UTCtime).astimezone(utc_tz)
localtime = UTCtime.astimezone(local_tz)
timestamp = int(time.mktime(UTCtime.timetuple()))
logger.debug("GPS time is " + str(localtime.strftime("%a %d %b %Y %H:%M:%S")) + " " + str(local_tz))
except IOError as ex:
if str(ex) == "[Errno 121] Remote I/O error":
logger.error("Could not access GPS!")
else:
logger.exception("Other IOError in get_gps_timestamp")
except Exception as ex:
logger.exception("Exceptionin get_gps_timestamp")
return UTCtime,localtime,timestamp
def get_gps_location(timeout=timeout):
nema_type="GGA"
latitude = None
longitude = None
altitude = None
try:
gpsfix = False
try:
gpsfix = gps.update(nema_type, timeout, waitforfix)
except TimeoutError:
logger.warning("Could not get GPS location within " + str(timeout) + " seconds!")
pass
if gpsfix:
latitude = gps.latitude
longitude = gps.longitude
altitude = gps.altitude
logger.debug(f""" Latitude: {latitude: .5f} Longitude: {longitude: .5f} Altitude: {altitude}""")
else:
logger.debug("No GPS fix!")
except IOError as ex:
if str(ex) == "[Errno 121] Remote I/O error":
logger.error("Could not access GPS!")
else:
logger.exception("other IOError in get_gps_location")
except Exception as ex:
logger.exception("Exception in get_gps_location")
return latitude, longitude, altitude
def set_timezonefromcoordinates(latitude, longitude):
try:
assert (latitude != None)
assert (longitude != None)
tf = TimezoneFinder()
strtimezone = tf.timezone_at(lng=longitude, lat=latitude)
logger.info("Set timezone to '" + strtimezone + "' based on latitude: " + str(latitude) + " longitude: " + str(longitude))
os.system(f"sudo timedatectl set-timezone {strtimezone}")
except AssertionError as ex:
logger.error("Invalid Coordinates, could not set timezone!")
except Exception as ex:
logger.exception("Exception " + str(ex))
return
def timesync_gps(gpsSensor):
try:
gps_values = {}
UTCtime,localtime,timestamp = None, None, None
timeout = 10
if 'timeout' in gpsSensor and gpsSensor["timeout"] is not None:
timeout = gpsSensor["timeout"]
logger.debug("Start receiving GPS location and time, waiting "+ str(timeout) + " seconds for GPS fix!")
latitude, longitude, altitude = get_gps_location(timeout)
#set_timezonefromcoordinates(latitude, longitude)
UTCtime,localtime,timestamp = get_gps_timestamp(timeout)
if UTCtime is not None and localtime is not None:
nowUTC = dt.datetime.now(utc_tz)
nowLOCAL = nowUTC.astimezone(local_tz)
updatesystemtime = False
abs_timedelta_totalseconds = round(get_abs_timedifference(nowUTC, UTCtime))
if abs_timedelta_totalseconds >= 300:
logger.critical("Difference between GPS time and sytstem time is " + str(abs_timedelta_totalseconds) + " seconds")
updatesystemtime = True
elif abs_timedelta_totalseconds >= 120:
logger.warning("Difference between GPS time and sytstem time is " + str(abs_timedelta_totalseconds) + " seconds")
else:
logger.debug("Difference between GPS time and sytstem time is " + str(abs_timedelta_totalseconds) + " seconds (GPS time provided by NMEA is not accurate!)")
if updatesystemtime:
logger.info('Writing GPS time ' + localtime.strftime("%a %d %b %Y %H:%M:%S") + ' to system, old time was ' + nowLOCAL.strftime("%a %d %b %Y %H:%M:%S") + ' ...')
value = os.system('sudo date -u -s "' + UTCtime.strftime("%d %b %Y %H:%M:%S") + '" >>/dev/null')
if value == 0:
logger.debug('Successfully wrote GPS time to system...')
else:
logger.error('Failure writing GPS time to system...')
except Exception as ex:
logger.exception("Exception in timesync_gps")
return False
def measure_gps_time(gpsSensor):
UTCtime,localtime,timestamp = None, None, None
try:
timeout = 10
if 'timeout' in gpsSensor and gpsSensor["timeout"] is not None:
timeout = gpsSensor["timeout"]
logger.debug("Start receiving GPS time, waiting "+ str(timeout) + " seconds for GPS fix!")
UTCtime,localtime,timestamp = get_gps_timestamp(timeout)
except Exception as ex:
logger.exception("Exception in measure_gps_time")
return UTCtime,localtime,timestamp
def measure_gps(gpsSensor):
gps_values = {}
try:
timeout = 10
if 'timeout' in gpsSensor and gpsSensor["timeout"] is not None:
timeout = gpsSensor["timeout"]
logger.debug("Start measureing GPS, waiting "+ str(timeout) + " seconds for GPS fix!")
gps_values['latitude'], gps_values['longitude'], gps_values['elevation'] = get_gps_location(timeout)
except Exception as ex:
logger.exception("Exception in measure_gps")
return gps_values
def main():
logging.basicConfig(level=logging.DEBUG)
try:
get_gps_timestamp()
get_gps_location()
except Exception as ex:
logger.exception("Unhandled Exception in main")
if __name__ == '__main__':
try:
main()
except (KeyboardInterrupt, SystemExit):
logger.debug("exit")
exit
except Exception as ex:
logger.error("Unhandled Exception in "+ __name__)