mawei/onepilot
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

plannerd: add frameId to uiPlan (#27573)

Browse Source 
* plannerd: add frameId to uiPlan

* update refs
old-commit-hash: 17b71b477e596529d36dc7f95e3fa42697adfadc
This commit is contained in:
Adeeb Shihadeh
2023-03-13 15:30:38 -07:00
committed by GitHub
parent bb553a2032
commit e2acf6ab14
3 changed files with 3 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
cereal

Submodule cereal updated: 42f84fd85d...9888e0476c

1
selfdrive/controls/plannerd.py
View File

@@ -19,6 +19,7 @@ def publish_ui_plan(sm, pm, lateral_planner, longitudinal_planner):
ui_send = messaging.new_message('uiPlan')
ui_send.valid = sm.all_checks(service_list=['carState', 'controlsState', 'modelV2'])
uiPlan = ui_send.uiPlan
uiPlan.frameId = sm['modelV2'].frameId
uiPlan.position.x = np.interp(plan_odo, model_odo, lateral_planner.lat_mpc.x_sol[:,0]).tolist()
uiPlan.position.y = np.interp(plan_odo, model_odo, lateral_planner.lat_mpc.x_sol[:,1]).tolist()
uiPlan.position.z = np.interp(plan_odo, model_odo, lateral_planner.path_xyz[:,2]).tolist()

2
selfdrive/test/process_replay/ref_commit
View File

@@ -1 +1 @@
f9c7e05b836c4bff364978752e82d64b90f9d6e6
3c5ebb007f76ba0de710ff7a8cf5910ad2edf22f