-
Notifications
You must be signed in to change notification settings - Fork 6
/
Copy pathchronotron.py
executable file
·241 lines (210 loc) · 7.22 KB
/
chronotron.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
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
#!/usr/bin/python
import time
from datetime import datetime
import subprocess
import gpsd # from gpsd-py3
import logging
from i2c_lcd import LcdDisplay
# from button import Button
def is_current_time_in_interval(start_time_str, end_time_str):
# Get the current local time
current_time = datetime.now().time()
# Parse start and end times from strings
start_time = datetime.strptime(start_time_str, "%H:%M").time()
end_time = datetime.strptime(end_time_str, "%H:%M").time()
# Check if the interval spans across midnight
if start_time > end_time:
return current_time >= start_time or current_time < end_time
else:
return start_time <= current_time <= end_time
def exec_cmd(cmd):
ret = []
p = subprocess.Popen(
cmd, stdout=subprocess.PIPE, stderr=subprocess.STDOUT, bufsize=-1
)
for line in p.stdout:
ret.append(line.decode("utf-8").strip())
p.wait()
if p.returncode != 0:
cm = ""
for c in cmd:
cm = cm + c + " "
print("Warning: " + cm + "failed: " + str(p.returncode))
return ret
def get_statistics(log, host="localhost"):
# Get number of active satellites from gpsd
n = 0
stats = {}
try:
gpsd.connect(host)
n = gpsd.get_current().sats_valid
stats["sats"] = n
except:
stats["sats"] = None
pass
# Get chrony tracking information
cmd = ["chronyc", "tracking"]
ret = exec_cmd(cmd)
stats["stratum"] = None
stats["system_time_offset"] = None
for line in ret:
pars = line.split(":", 1)
if len(pars) == 2:
parm = pars[0].strip()
if parm == "System time":
sub_pars = pars[1].strip().split(" ")
if len(sub_pars) > 2:
val = float(sub_pars[0])
if "slow" == sub_pars[2]:
val = -1.0 * val
stats["system_time_offset"] = val
elif parm == "Stratum":
try:
n = int(pars[1])
stats["stratum"] = n
except:
stats["stratum"] = None
# Get current time source
cmd = ["chronyc", "sources"]
ret = exec_cmd(cmd)
stats["is_locked"] = False
stats["is_pps"] = False
stats["source"] = None
stats["adjusted_offset"] = None
for line in ret:
if "#* PPS" in line:
stats["is_locked"] = True
stats["is_pps"] = True
stats["source"] = "PPS"
# #* PPS0 0 4 377 22 +271ns[ +385ns] +
try:
stats["adjusted_offset"] = line[50:59].strip()
except:
pass
else:
if "^*" in line:
stats["is_locked"] = True
stats["is_pps"] = False
try:
stats["source"] = line[3:33].strip()
except:
pass
try:
stats["adjusted_offset"] = line[50:59].strip()
except:
pass
return stats
def main_loop():
last_time = ""
last_offset = ""
select_state = 0
select_states = 2
trigger_time = 0
main_state = 0
main_states = 2
old_lock = False
old_pps = False
old_stratum = None
old_src = None
version = "2.0.0"
# Time interval for backlight, set to None for permanent backlight:
start_time = "07:00"
end_time = "21:00"
logging.basicConfig(level=logging.INFO)
log = logging.getLogger("Chronotron")
log.setLevel("INFO")
log.info(f"Chronotron version {version} starting")
def select_button():
nonlocal select_state
nonlocal select_states
nonlocal trigger_time
trigger_time = time.time()
select_state = (select_state + 1) % select_states
def main_button():
nonlocal main_state
nonlocal main_states
nonlocal trigger_time
trigger_time = time.time()
main_state = (main_state + 1) % main_states
# bt = Button([(27, "blue", select_button), (22, "black", main_button)])
lcd = LcdDisplay(sm_bus=1, i2c_addr=0x27, cols=20, rows=4)
if lcd.active is False:
log.error("Failed to open display, exiting...")
exit(-1)
while True:
time_str = time.strftime("%Y-%m-%d %H:%M:%S")
if time_str != last_time:
if (
start_time is None
or end_time is None
or is_current_time_in_interval(start_time, end_time)
or start_time == end_time
):
lcd.set_backlight(True)
else:
lcd.set_backlight(False)
last_time = time_str
stats = get_statistics(log)
if stats["is_locked"] != old_lock:
old_lock = stats["is_locked"]
if old_lock is True:
log.info("Chrony aquired lock to time source")
if old_src != stats["source"]:
old_src = stats["source"]
if old_src is None:
src = "None"
else:
src = old_src
log.info(f"Chrony receiving time source from {src}")
if old_stratum != stats["stratum"]:
old_stratum = stats["stratum"]
if old_stratum is None:
strat = "?"
else:
strat = old_stratum
log.info(f"Chrony stratum level changed to {old_stratum}")
if old_pps != stats["is_pps"]:
old_pps = stats["is_pps"]
if old_pps:
log.info("Chrony locked to high precision GPS PPS signal")
else:
log.info("Chrony lost PPS signal")
# if select_state == 0:
# lcd.print_row(0, time_str)
# else:
# if time.time() - trigger_time > 10:
# select_state = 0
# lcd.print_row(0, "Select 1")
offset = stats["system_time_offset"]
offs = " "
if offset is not None:
if stats["stratum"] is None:
offs = "S[?]"
else:
offs = f"S[{stats['stratum']}]"
offs += " {:+12.9f}sec".format(offset)
if offs != last_offset:
last_offset = offs
if stats["sats"] is None:
sats = "--"
else:
sats = f"{stats['sats']:02}"
if stats["is_locked"]:
source_str = "L[*] "
else:
source_str = "L[ ] "
if stats["source"] is None:
source_str += " "
else:
source_str += stats["source"]
if stats["adjusted_offset"] is None:
dev_str = " "
else:
dev_str = f"{stats['adjusted_offset']:>7}"
last_str = f"SATS[{sats}] {dev_str}"
lcd.print_row(0, time_str)
lcd.print_row(1, offs)
lcd.print_row(2, source_str)
lcd.print_row(3, last_str)
time.sleep(0.05)
main_loop()