Skip to content

Commit

Permalink
untested: minor adjustment to further reduce noise
Browse files Browse the repository at this point in the history
  • Loading branch information
Gernby committed Nov 12, 2018
1 parent 1251809 commit 66ec2bc
Showing 1 changed file with 3 additions and 3 deletions.
6 changes: 3 additions & 3 deletions selfdrive/controls/lib/latcontrol.py
Expand Up @@ -72,7 +72,7 @@ def update(self, active, v_ego, angle_steers, steer_override, d_poly, angle_offs
# TODO: this creates issues in replay when rewinding time: mpc won't run
if self.last_mpc_ts < PL.last_md_ts:
self.last_mpc_ts = PL.last_md_ts
self.angle_steers_des_prev = self.angle_steers_des_mpc
self.angle_steers_des_prev = angle_steers # self.angle_steers_des_mpc

curvature_factor = VM.curvature_factor(v_ego)

Expand Down Expand Up @@ -118,9 +118,9 @@ def update(self, active, v_ego, angle_steers, steer_override, d_poly, angle_offs
else:
# TODO: ideally we should interp, but for tuning reasons we keep the mpc solution
# constant for 0.05s.
dt = min(cur_time - self.angle_steers_des_time, _DT_MPC + _DT) + _DT # no greater than dt mpc + dt, to prevent too high extraps
dt = min(cur_time - self.angle_steers_des_time + _DT, _DT_MPC) # no greater than dt mpc, to prevent overshooting
self.angle_steers_des = self.angle_steers_des_prev + (dt / _DT_MPC) * (self.angle_steers_des_mpc - self.angle_steers_des_prev)
#self.angle_steers_des = self.angle_steers_des_mpc
#self.angle_steers_des = ((4.0 * self.angle_steers_des + self.angle_steers_des_mpc) / 5.0
steers_max = get_steer_max(VM.CP, v_ego)
self.pid.pos_limit = steers_max
self.pid.neg_limit = -steers_max
Expand Down

0 comments on commit 66ec2bc

Please sign in to comment.