You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
52 lines
1.6 KiB
52 lines
1.6 KiB
from opendbc.car.common.conversions import Conversions as CV
|
|
from opendbc.car.tesla.values import CANBUS, CarControllerParams
|
|
|
|
|
|
class TeslaCAN:
|
|
def __init__(self, packer):
|
|
self.packer = packer
|
|
|
|
def create_steering_control(self, angle, enabled):
|
|
values = {
|
|
"DAS_steeringAngleRequest": -angle,
|
|
"DAS_steeringHapticRequest": 0,
|
|
"DAS_steeringControlType": 1 if enabled else 0,
|
|
}
|
|
|
|
return self.packer.make_can_msg("DAS_steeringControl", CANBUS.party, values)
|
|
|
|
def create_longitudinal_command(self, acc_state, accel, counter, v_ego, active):
|
|
from opendbc.car.interfaces import V_CRUISE_MAX
|
|
|
|
set_speed = max(v_ego * CV.MS_TO_KPH, 0)
|
|
if active:
|
|
# TODO: this causes jerking after gas override when above set speed
|
|
set_speed = 0 if accel < 0 else V_CRUISE_MAX
|
|
|
|
values = {
|
|
"DAS_setSpeed": set_speed,
|
|
"DAS_accState": acc_state,
|
|
"DAS_aebEvent": 0,
|
|
"DAS_jerkMin": CarControllerParams.JERK_LIMIT_MIN,
|
|
"DAS_jerkMax": CarControllerParams.JERK_LIMIT_MAX,
|
|
"DAS_accelMin": accel,
|
|
"DAS_accelMax": max(accel, 0),
|
|
"DAS_controlCounter": counter,
|
|
}
|
|
return self.packer.make_can_msg("DAS_control", CANBUS.party, values)
|
|
|
|
def create_steering_allowed(self):
|
|
values = {
|
|
"APS_eacAllow": 1,
|
|
}
|
|
|
|
return self.packer.make_can_msg("APS_eacMonitor", CANBUS.party, values)
|
|
|
|
|
|
def tesla_checksum(address: int, sig, d: bytearray) -> int:
|
|
checksum = (address & 0xFF) + ((address >> 8) & 0xFF)
|
|
checksum_byte = sig.start_bit // 8
|
|
for i in range(len(d)):
|
|
if i != checksum_byte:
|
|
checksum += d[i]
|
|
return checksum & 0xFF
|
|
|