Skip to content

Commit e39c02a

Browse files
committed
only give raw desired curvature to torque controlled platforms
1 parent c3feb8f commit e39c02a

File tree

2 files changed

+10
-4
lines changed

2 files changed

+10
-4
lines changed

selfdrive/controls/controlsd.py

Lines changed: 9 additions & 3 deletions
Original file line numberDiff line numberDiff line change
@@ -123,9 +123,15 @@ def state_control(self):
123123
curvature_limited = curvature_limited or raw_curvature_limited
124124

125125
actuators.curvature = self.desired_curvature
126-
steer, steeringAngleDeg, lac_log = self.LaC.update(CC.latActive, CS, self.VM, lp,
127-
self.steer_limited_by_safety, self.desired_curvature, new_raw_desired_curvature,
128-
curvature_limited) # TODO what if not available
126+
127+
if self.CP.lateralTuning.which() == 'torque':
128+
steer, steeringAngleDeg, lac_log = self.LaC.update(CC.latActive, CS, self.VM, lp,
129+
self.steer_limited_by_safety, self.desired_curvature, new_raw_desired_curvature,
130+
curvature_limited) # TODO what if not available
131+
else:
132+
steer, steeringAngleDeg, lac_log = self.LaC.update(CC.latActive, CS, self.VM, lp,
133+
self.steer_limited_by_safety, self.desired_curvature,
134+
curvature_limited) # TODO what if not available
129135
actuators.torque = float(steer)
130136
actuators.steeringAngleDeg = float(steeringAngleDeg)
131137
# Ensure no NaNs/Infs

selfdrive/controls/lib/latcontrol.py

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -15,7 +15,7 @@ def __init__(self, CP, CI):
1515
self.steer_max = 1.0
1616

1717
@abstractmethod
18-
def update(self, active, CS, VM, params, steer_limited_by_safety, desired_curvature, calibrated_pose, curvature_limited):
18+
def update(self, active, CS, VM, params, steer_limited_by_safety, desired_curvature, curvature_limited):
1919
pass
2020

2121
def reset(self):

0 commit comments

Comments
 (0)