Skip to content

Commit

Permalink
more cleanup
Browse files Browse the repository at this point in the history
  • Loading branch information
Gernby committed Jan 7, 2019
1 parent c3ebdf2 commit c734116
Showing 1 changed file with 4 additions and 8 deletions.
12 changes: 4 additions & 8 deletions selfdrive/controls/lib/latcontrol.py
Original file line number Diff line number Diff line change
Expand Up @@ -57,7 +57,6 @@ def __init__(self, CP):
self.feed_forward = 0.0
self.last_mpc_ts = 0.0
self.angle_steers_des = 0.0
self.angle_steers_des_mpc = 0.0
self.angle_steers_des_time = 0.0
self.projected_angle_steers = 0.0
self.steer_counter = 1.0
Expand Down Expand Up @@ -144,9 +143,6 @@ def update(self, active, v_ego, angle_steers, angle_rate, steer_override, d_poly
self.mpc_times = [self.angle_steers_des_time,
mpc_time + _DT_MPC,
mpc_time + _DT_MPC + _DT_MPC]

# Is this property used outside of LaC?
self.angle_steers_des_mpc = self.mpc_angles[1]
else:
self.libmpc.init(MPC_COST_LAT.PATH, MPC_COST_LAT.LANE, MPC_COST_LAT.HEADING, CP.steerRateCost)
self.cur_state[0].delta = math.radians(angle_steers) / CP.steerRatio
Expand Down Expand Up @@ -187,8 +183,8 @@ def update(self, active, v_ego, angle_steers, angle_rate, steer_override, d_poly
deadzone = 0.0

if CP.steerControlType == car.CarParams.SteerControlType.torque:
# Decide which feed forward mode should be used (angle or rate). Use more dominant mode, and only if conditions are met
# Spread feed forward out over a period of time to make it more inductive (for resonance)
# Decide which feed forward mode should be used (angle or rate). Use more dominant mode, but only if conditions are met
# Spread feed forward out over a period of time to make it inductive (for resonance)
if abs(self.ff_rate_factor * float(restricted_steer_rate)) > abs(self.ff_angle_factor * float(self.angle_steers_des) - float(angle_offset)) - 0.5 \
and (abs(float(restricted_steer_rate)) > abs(accelerated_angle_rate) or (float(restricted_steer_rate) < 0) != (accelerated_angle_rate < 0)) \
and (float(restricted_steer_rate) < 0) == (float(self.angle_steers_des) - float(angle_offset) - 0.5 < 0):
Expand All @@ -209,6 +205,6 @@ def update(self, active, v_ego, angle_steers, angle_rate, steer_override, d_poly

# return MPC angle in the unused output (for ALCA)
if CP.steerControlType == car.CarParams.SteerControlType.torque:
return output_steer, float(self.angle_steers_des_mpc)
return output_steer, self.mpc_angles[1]
else:
return float(self.angle_steers_des_mpc), float(self.angle_steers_des)
return self.mpc_angles[1], float(self.angle_steers_des)

0 comments on commit c734116

Please sign in to comment.