|
|
|
@ -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) |
|
|
|
|
|
|
|
|
|