|
|
|
@ -53,7 +53,6 @@ class PathPlanner(): |
|
|
|
|
|
|
|
|
|
self.setup_mpc() |
|
|
|
|
self.solution_invalid_cnt = 0 |
|
|
|
|
self.path_offset_i = 0.0 |
|
|
|
|
self.lane_change_state = LaneChangeState.off |
|
|
|
|
self.lane_change_direction = LaneChangeDirection.none |
|
|
|
|
self.lane_change_timer = 0.0 |
|
|
|
@ -150,15 +149,6 @@ class PathPlanner(): |
|
|
|
|
|
|
|
|
|
self.LP.update_d_poly(v_ego) |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
# TODO: Check for active, override, and saturation |
|
|
|
|
# if active: |
|
|
|
|
# self.path_offset_i += self.LP.d_poly[3] / (60.0 * 20.0) |
|
|
|
|
# self.path_offset_i = clip(self.path_offset_i, -0.5, 0.5) |
|
|
|
|
# self.LP.d_poly[3] += self.path_offset_i |
|
|
|
|
# else: |
|
|
|
|
# self.path_offset_i = 0.0 |
|
|
|
|
|
|
|
|
|
# account for actuation delay |
|
|
|
|
self.cur_state = calc_states_after_delay(self.cur_state, v_ego, angle_steers - angle_offset, curvature_factor, VM.sR, CP.steerActuatorDelay) |
|
|
|
|
|
|
|
|
|