diff --git a/selfdrive/controls/lib/legacy_longitudinal_mpc_lib/long_mpc.py b/selfdrive/controls/lib/legacy_longitudinal_mpc_lib/long_mpc.py index 653f0d010..0ae91f427 100644 --- a/selfdrive/controls/lib/legacy_longitudinal_mpc_lib/long_mpc.py +++ b/selfdrive/controls/lib/legacy_longitudinal_mpc_lib/long_mpc.py @@ -372,8 +372,8 @@ class LongitudinalMpc: # distance that lead needs as a minimum. We can add that to the current distance # and then treat that as a stopped car/obstacle at this new distance. if use_krkeegen_tune: - lead_0_obstacle = lead_xv_0[:,0] + get_stopped_equivalence_factor(lead_xv_0[:,1], v_ego) - lead_1_obstacle = lead_xv_1[:,0] + get_stopped_equivalence_factor(lead_xv_1[:,1], v_ego) + lead_0_obstacle = lead_xv_0[:,0] + get_stopped_equivalence_factor_krkeegen(lead_xv_0[:,1], v_ego) + lead_1_obstacle = lead_xv_1[:,0] + get_stopped_equivalence_factor_krkeegen(lead_xv_1[:,1], v_ego) else: lead_0_obstacle = lead_xv_0[:,0] + get_stopped_equivalence_factor(lead_xv_0[:,1]) lead_1_obstacle = lead_xv_1[:,0] + get_stopped_equivalence_factor(lead_xv_1[:,1])