Toyota carcontroller: use class variable (#28733)

* use params

* better names
old-commit-hash: dc83752bc0
beeps
Shane Smiskol 2 years ago committed by GitHub
parent d1b891c419
commit be977ffe5b
  1. 10
      selfdrive/car/toyota/carcontroller.py
  2. 6
      selfdrive/car/toyota/toyotacan.py

@ -22,7 +22,7 @@ MAX_USER_TORQUE = 500
class CarController: class CarController:
def __init__(self, dbc_name, CP, VM): def __init__(self, dbc_name, CP, VM):
self.CP = CP self.CP = CP
self.torque_rate_limits = CarControllerParams(self.CP) self.params = CarControllerParams(self.CP)
self.frame = 0 self.frame = 0
self.last_steer = 0 self.last_steer = 0
self.alert_active = False self.alert_active = False
@ -56,11 +56,11 @@ class CarController:
interceptor_gas_cmd = clip(pedal_command, 0., MAX_INTERCEPTOR_GAS) interceptor_gas_cmd = clip(pedal_command, 0., MAX_INTERCEPTOR_GAS)
else: else:
interceptor_gas_cmd = 0. interceptor_gas_cmd = 0.
pcm_accel_cmd = clip(actuators.accel, CarControllerParams.ACCEL_MIN, CarControllerParams.ACCEL_MAX) pcm_accel_cmd = clip(actuators.accel, self.params.ACCEL_MIN, self.params.ACCEL_MAX)
# steer torque # steer torque
new_steer = int(round(actuators.steer * CarControllerParams.STEER_MAX)) new_steer = int(round(actuators.steer * self.params.STEER_MAX))
apply_steer = apply_meas_steer_torque_limits(new_steer, self.last_steer, CS.out.steeringTorqueEps, self.torque_rate_limits) apply_steer = apply_meas_steer_torque_limits(new_steer, self.last_steer, CS.out.steeringTorqueEps, self.params)
# Count up to MAX_STEER_RATE_FRAMES, at which point we need to cut torque to avoid a steering fault # Count up to MAX_STEER_RATE_FRAMES, at which point we need to cut torque to avoid a steering fault
if lat_active and abs(CS.out.steeringRateDeg) >= MAX_STEER_RATE: if lat_active and abs(CS.out.steeringRateDeg) >= MAX_STEER_RATE:
@ -162,7 +162,7 @@ class CarController:
can_sends.append(make_can_msg(addr, vl, bus)) can_sends.append(make_can_msg(addr, vl, bus))
new_actuators = actuators.copy() new_actuators = actuators.copy()
new_actuators.steer = apply_steer / CarControllerParams.STEER_MAX new_actuators.steer = apply_steer / self.params.STEER_MAX
new_actuators.steerOutputCan = apply_steer new_actuators.steerOutputCan = apply_steer
new_actuators.accel = self.accel new_actuators.accel = self.accel
new_actuators.gas = self.gas new_actuators.gas = self.gas

@ -9,17 +9,17 @@ def create_steer_command(packer, steer, steer_req):
return packer.make_can_msg("STEERING_LKA", 0, values) return packer.make_can_msg("STEERING_LKA", 0, values)
def create_lta_steer_command(packer, steer, steer_req, raw_cnt): def create_lta_steer_command(packer, steer_angle, steer_req, frame):
"""Creates a CAN message for the Toyota LTA Steer Command.""" """Creates a CAN message for the Toyota LTA Steer Command."""
values = { values = {
"COUNTER": raw_cnt + 128, "COUNTER": frame + 128,
"SETME_X1": 1, "SETME_X1": 1,
"SETME_X3": 3, "SETME_X3": 3,
"PERCENTAGE": 100, "PERCENTAGE": 100,
"SETME_X64": 0, "SETME_X64": 0,
"ANGLE": 0, "ANGLE": 0,
"STEER_ANGLE_CMD": steer, "STEER_ANGLE_CMD": steer_angle,
"STEER_REQUEST": steer_req, "STEER_REQUEST": steer_req,
"STEER_REQUEST_2": steer_req, "STEER_REQUEST_2": steer_req,
"BIT": 0, "BIT": 0,

Loading…
Cancel
Save