|
|
@ -231,7 +231,8 @@ def main(demo=False): |
|
|
|
desire = DH.desire |
|
|
|
desire = DH.desire |
|
|
|
is_rhd = sm["driverMonitoringState"].isRHD |
|
|
|
is_rhd = sm["driverMonitoringState"].isRHD |
|
|
|
frame_id = sm["roadCameraState"].frameId |
|
|
|
frame_id = sm["roadCameraState"].frameId |
|
|
|
lateral_control_params = np.array([sm["carState"].vEgo, steer_delay], dtype=np.float32) |
|
|
|
v_ego = max(sm["carState"].vEgo, 0.) |
|
|
|
|
|
|
|
lateral_control_params = np.array([v_ego, steer_delay], dtype=np.float32) |
|
|
|
if sm.updated["liveCalibration"] and sm.seen['roadCameraState'] and sm.seen['deviceState']: |
|
|
|
if sm.updated["liveCalibration"] and sm.seen['roadCameraState'] and sm.seen['deviceState']: |
|
|
|
device_from_calib_euler = np.array(sm["liveCalibration"].rpyCalib, dtype=np.float32) |
|
|
|
device_from_calib_euler = np.array(sm["liveCalibration"].rpyCalib, dtype=np.float32) |
|
|
|
dc = DEVICE_CAMERAS[(str(sm['deviceState'].deviceType), str(sm['roadCameraState'].sensor))] |
|
|
|
dc = DEVICE_CAMERAS[(str(sm['deviceState'].deviceType), str(sm['roadCameraState'].sensor))] |
|
|
|