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

long_mpc: clean up get_T_FOLLOW() usage (#29033)

Browse Source 
old-commit-hash: 7a5dbe6132cc363570fe6fac106661f01b1319e2
This commit is contained in:
eFini
2023-07-19 17:07:01 +08:00
committed by GitHub
parent 3eee5ac744
commit 05181ed6b1
1 changed files with 1 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
selfdrive/controls/lib/longitudinal_mpc_lib/long_mpc.py
View File

@@ -357,7 +357,7 @@ class LongitudinalMpc:
v_cruise_clipped = np.clip(v_cruise * np.ones(N+1),
v_lower,
v_upper)
cruise_obstacle = np.cumsum(T_DIFFS * v_cruise_clipped) + get_safe_obstacle_distance(v_cruise_clipped, get_T_FOLLOW(personality))
cruise_obstacle = np.cumsum(T_DIFFS * v_cruise_clipped) + get_safe_obstacle_distance(v_cruise_clipped, t_follow)
x_obstacles = np.column_stack([lead_0_obstacle, lead_1_obstacle, cruise_obstacle])
self.source = SOURCES[np.argmin(x_obstacles[0])]