mirror of
https://github.com/firestar5683/StarPilot.git
synced 2026-07-06 22:22:11 +08:00
Fallback publish calib (#1392)
* if no inputs still publish * better old-commit-hash: 28d8b4abac1a97905a74ea126d275125d2e93cd0
This commit is contained in:
@@ -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)
|
||||
|
||||
|
||||
Reference in New Issue
Block a user