dragonpilot - 基於 openpilot 的開源駕駛輔助系統
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
|
|
|
|
#!/usr/bin/env python3
|
|
|
|
|
import time
|
|
|
|
|
import cereal.messaging as messaging
|
|
|
|
|
|
|
|
|
|
if __name__ == "__main__":
|
|
|
|
|
sm = messaging.SubMaster(['ubloxGnss', 'gpsLocationExternal'])
|
|
|
|
|
|
|
|
|
|
while 1:
|
|
|
|
|
ug = sm['ubloxGnss']
|
|
|
|
|
gle = sm['gpsLocationExternal']
|
|
|
|
|
|
|
|
|
|
try:
|
|
|
|
|
cnos = []
|
|
|
|
|
for m in ug.measurementReport.measurements:
|
|
|
|
|
cnos.append(m.cno)
|
|
|
|
|
print("Sats: %d Accuracy: %.2f m cnos" % (ug.measurementReport.numMeas, gle.horizontalAccuracy), sorted(cnos))
|
|
|
|
|
except Exception:
|
|
|
|
|
pass
|
|
|
|
|
sm.update()
|
|
|
|
|
time.sleep(0.1)
|
