|
|
|
@ -109,12 +109,6 @@ static void update_state(UIState *s) { |
|
|
|
|
SubMaster &sm = *(s->sm); |
|
|
|
|
UIScene &scene = s->scene; |
|
|
|
|
|
|
|
|
|
if (sm.updated("modelV2")) { |
|
|
|
|
update_model(s, sm["modelV2"].getModelV2()); |
|
|
|
|
} |
|
|
|
|
if (sm.updated("radarState") && sm.rcv_frame("modelV2") >= s->scene.started_frame) { |
|
|
|
|
update_leads(s, sm["radarState"].getRadarState(), sm["modelV2"].getModelV2().getPosition()); |
|
|
|
|
} |
|
|
|
|
if (sm.updated("liveCalibration")) { |
|
|
|
|
auto rpy_list = sm["liveCalibration"].getLiveCalibration().getRpyCalib(); |
|
|
|
|
Eigen::Vector3d rpy; |
|
|
|
@ -131,6 +125,14 @@ static void update_state(UIState *s) { |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
if (s->worldObjectsVisible()) { |
|
|
|
|
if (sm.updated("modelV2")) { |
|
|
|
|
update_model(s, sm["modelV2"].getModelV2()); |
|
|
|
|
} |
|
|
|
|
if (sm.updated("radarState") && sm.rcv_frame("modelV2") >= s->scene.started_frame) { |
|
|
|
|
update_leads(s, sm["radarState"].getRadarState(), sm["modelV2"].getModelV2().getPosition()); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
if (sm.updated("pandaStates")) { |
|
|
|
|
auto pandaStates = sm["pandaStates"].getPandaStates(); |
|
|
|
|
if (pandaStates.size() > 0) { |
|
|
|
|