Fallback publish calib (#1392)

* if no inputs still publish

* better
old-commit-hash: 28d8b4abac
commatwo_master
HaraldSchafer 5 years ago committed by GitHub
parent 93a539e7ff
commit 7ae46f0cde
  1. 6
      selfdrive/locationd/calibrationd.py

@ -147,6 +147,11 @@ def calibrationd_thread(sm=None, pm=None):
while 1:
sm.update()
# if no inputs still publish calibration
if not sm.updated['carState'] and not sm.updated['cameraOdometry']:
calibrator.send_data(pm)
continue
if sm.updated['carState']:
calibrator.handle_v_ego(sm['carState'].vEgo)
if send_counter % 25 == 0:
@ -159,6 +164,7 @@ def calibrationd_thread(sm=None, pm=None):
sm['cameraOdometry'].transStd,
sm['cameraOdometry'].rotStd)
if DEBUG and new_vp is not None:
print('got new vp', new_vp)

Loading…
Cancel
Save