pull/35029/head
Bruce Wayne 1 month ago
parent f27eaef163
commit 5a45904407
  1. 4
      selfdrive/controls/lib/longitudinal_planner.py

@ -162,8 +162,8 @@ class LongitudinalPlanner:
action_t = self.CP.longitudinalActuatorDelay + DT_MDL
output_a_target, self.output_should_stop = get_accel_from_plan(self.v_desired_trajectory, self.a_desired_trajectory, CONTROL_N_T_IDX,
action_t=action_t, vEgoStopping=self.CP.vEgoStopping)
output_a_target_e2e, output_should_stop_e2e = get_accel_from_plan(np.interp(CONTROL_N_T_IDX, ModelConstants.T_IDXS, model_msg.velocity.x),
np.interp(CONTROL_N_T_IDX, ModelConstants.T_IDXS, model_msg.acceleration.x),
output_a_target_e2e, output_should_stop_e2e = get_accel_from_plan(np.interp(CONTROL_N_T_IDX, ModelConstants.T_IDXS, sm['modelV2'].velocity.x),
np.interp(CONTROL_N_T_IDX, ModelConstants.T_IDXS, sm['modelV2'].acceleration.x),
action_t=action_t, vEgoStopping=self.CP.vEgoStopping)
if self.mode == 'acc':
output_a_target = output_a_target_mpc

Loading…
Cancel
Save