mirror of
https://github.com/infiniteCable2/opendbc.git
synced 2026-06-08 10:54:51 +08:00
c4f5a4f9d2
# Conflicts: # docs/CARS.md # opendbc/car/car_helpers.py # opendbc/car/chrysler/carcontroller.py # opendbc/car/chrysler/values.py # opendbc/car/honda/carcontroller.py # opendbc/car/honda/hondacan.py # opendbc/car/hyundai/hyundaicanfd.py # opendbc/car/rivian/interface.py
248 lines
10 KiB
C
248 lines
10 KiB
C
#pragma once
|
|
|
|
#include "opendbc/safety/declarations.h"
|
|
#include "opendbc/safety/modes/chrysler_common.h"
|
|
|
|
// Chrysler Pacifica/Jeep addresses
|
|
#define CHRYSLER_EPS_2 0x220 // EPS driver input torque
|
|
#define CHRYSLER_ESP_1 0x140 // Brake pedal and vehicle speed
|
|
#define CHRYSLER_ESP_8 0x11C // Brake pedal and vehicle speed
|
|
#define CHRYSLER_ECM_5 0x22F // Throttle position sensor
|
|
#define CHRYSLER_DAS_3 0x1F4 // ACC engagement states from DASM
|
|
#define CHRYSLER_DAS_6 0x2A6 // LKAS HUD and auto headlight control from DASM
|
|
#define CHRYSLER_LKAS_COMMAND 0x292 // LKAS controls from DASM
|
|
#define CHRYSLER_CRUISE_BUTTONS 0x23B // Cruise control buttons
|
|
#define CHRYSLER_LKAS_HEARTBIT 0x2D9 // LKAS HEARTBIT from DASM
|
|
#define CHRYSLER_TRACTION_BUTTON 0x330 // Traction control button
|
|
#define CHRYSLER_Center_Stack_2 0x000 // Placeholder, does not exist
|
|
|
|
// RAM DT addresses
|
|
#define CHRYSLER_RAM_DT_EPS_2 0x31
|
|
#define CHRYSLER_RAM_DT_ESP_1 0x83
|
|
#define CHRYSLER_RAM_DT_ESP_8 0x79
|
|
#define CHRYSLER_RAM_DT_ECM_5 0x9D
|
|
#define CHRYSLER_RAM_DT_DAS_3 0x99
|
|
#define CHRYSLER_RAM_DT_DAS_6 0xFA
|
|
#define CHRYSLER_RAM_DT_LKAS_COMMAND 0xA6
|
|
#define CHRYSLER_RAM_DT_CRUISE_BUTTONS 0xB1
|
|
#define CHRYSLER_RAM_DT_LKAS_HEARTBIT 0x00 // Placeholder, does not exist
|
|
#define CHRYSLER_RAM_DT_TRACTION_BUTTON 0x00 // Placeholder, does not exist
|
|
#define CHRYSLER_RAM_DT_Center_Stack_2 0x28A
|
|
|
|
// RAM HD addresses
|
|
#define CHRYSLER_RAM_HD_EPS_2 0x220
|
|
#define CHRYSLER_RAM_HD_ESP_1 0x140
|
|
#define CHRYSLER_RAM_HD_ESP_8 0x11C
|
|
#define CHRYSLER_RAM_HD_ECM_5 0x22F
|
|
#define CHRYSLER_RAM_HD_DAS_3 0x1F4
|
|
#define CHRYSLER_RAM_HD_DAS_6 0x275
|
|
#define CHRYSLER_RAM_HD_LKAS_COMMAND 0x276
|
|
#define CHRYSLER_RAM_HD_CRUISE_BUTTONS 0x23A
|
|
#define CHRYSLER_RAM_HD_LKAS_HEARTBIT 0x00 // Placeholder, does not exist
|
|
#define CHRYSLER_RAM_HD_TRACTION_BUTTON 0x00 // Placeholder, does not exist
|
|
#define CHRYSLER_RAM_HD_Center_Stack_2 0x28A
|
|
|
|
typedef enum {
|
|
CHRYSLER_RAM_DT,
|
|
CHRYSLER_RAM_HD,
|
|
CHRYSLER_PACIFICA, // plus Jeep
|
|
} ChryslerPlatform;
|
|
static ChryslerPlatform chrysler_platform;
|
|
|
|
#define CHRYSLER_ADDR(name) ((uint32_t)((chrysler_platform == CHRYSLER_RAM_DT) ? CHRYSLER_RAM_DT_##name : \
|
|
((chrysler_platform == CHRYSLER_RAM_HD) ? CHRYSLER_RAM_HD_##name : CHRYSLER_##name)))
|
|
|
|
|
|
static uint8_t chrysler_get_counter(const CANPacket_t *msg) {
|
|
return (uint8_t)(msg->data[6] >> 4);
|
|
}
|
|
|
|
static void chrysler_rx_hook(const CANPacket_t *msg) {
|
|
// Measured EPS torque
|
|
if ((msg->bus == 0U) && (msg->addr == CHRYSLER_ADDR(EPS_2))) {
|
|
int torque_meas_new = ((msg->data[4] & 0x7U) << 8) + msg->data[5] - 1024U;
|
|
update_sample(&torque_meas, torque_meas_new);
|
|
}
|
|
|
|
// enter controls on rising edge of ACC, exit controls on ACC off
|
|
const unsigned int das_3_bus = (chrysler_platform == CHRYSLER_PACIFICA) ? 0U : 2U;
|
|
if ((msg->bus == das_3_bus) && (msg->addr == CHRYSLER_ADDR(DAS_3))) {
|
|
bool cruise_engaged = GET_BIT(msg, 21U);
|
|
pcm_cruise_check(cruise_engaged);
|
|
acc_main_on = GET_BIT(msg, 20U);
|
|
}
|
|
|
|
// TODO: use the same message for both
|
|
// update vehicle moving
|
|
if ((chrysler_platform != CHRYSLER_PACIFICA) && (msg->bus == 0U) && (msg->addr == CHRYSLER_ADDR(ESP_8))) {
|
|
vehicle_moving = ((msg->data[4] << 8) + msg->data[5]) != 0U;
|
|
}
|
|
if ((chrysler_platform == CHRYSLER_PACIFICA) && (msg->bus == 0U) && (msg->addr == 514U)) {
|
|
int speed_l = (msg->data[0] << 4) + (msg->data[1] >> 4);
|
|
int speed_r = (msg->data[2] << 4) + (msg->data[3] >> 4);
|
|
vehicle_moving = (speed_l != 0) || (speed_r != 0);
|
|
}
|
|
|
|
// exit controls on rising edge of gas press
|
|
if ((msg->bus == 0U) && (msg->addr == CHRYSLER_ADDR(ECM_5))) {
|
|
gas_pressed = msg->data[0U] != 0U;
|
|
}
|
|
|
|
// exit controls on rising edge of brake press
|
|
if ((msg->bus == 0U) && (msg->addr == CHRYSLER_ADDR(ESP_1))) {
|
|
brake_pressed = ((msg->data[0U] & 0xFU) >> 2U) == 1U;
|
|
}
|
|
|
|
if ((chrysler_platform == CHRYSLER_PACIFICA) && (msg->bus == 0U) && (msg->addr == CHRYSLER_ADDR(TRACTION_BUTTON))) {
|
|
mads_button_press = GET_BIT(msg, 53U) ? MADS_BUTTON_PRESSED : MADS_BUTTON_NOT_PRESSED;
|
|
}
|
|
|
|
if ((chrysler_platform != CHRYSLER_PACIFICA) && (msg->bus == 0U)) {
|
|
if (msg->addr == CHRYSLER_ADDR(Center_Stack_2)) {
|
|
mads_button_press = GET_BIT(msg, 57U) ? MADS_BUTTON_PRESSED : MADS_BUTTON_NOT_PRESSED;
|
|
}
|
|
}
|
|
}
|
|
|
|
static bool chrysler_tx_hook(const CANPacket_t *msg) {
|
|
const TorqueSteeringLimits CHRYSLER_STEERING_LIMITS = {
|
|
.max_torque = 261,
|
|
.max_rt_delta = 112,
|
|
.max_rate_up = 3,
|
|
.max_rate_down = 3,
|
|
.max_torque_error = 80,
|
|
.type = TorqueMotorLimited,
|
|
};
|
|
|
|
const TorqueSteeringLimits CHRYSLER_RAM_DT_STEERING_LIMITS = {
|
|
.max_torque = 350,
|
|
.max_rt_delta = 112,
|
|
.max_rate_up = 6,
|
|
.max_rate_down = 6,
|
|
.max_torque_error = 80,
|
|
.type = TorqueMotorLimited,
|
|
};
|
|
|
|
const TorqueSteeringLimits CHRYSLER_RAM_HD_STEERING_LIMITS = {
|
|
.max_torque = 361,
|
|
.max_rt_delta = 182,
|
|
.max_rate_up = 14,
|
|
.max_rate_down = 14,
|
|
.max_torque_error = 80,
|
|
.type = TorqueMotorLimited,
|
|
};
|
|
|
|
bool tx = true;
|
|
|
|
// STEERING
|
|
if (msg->addr == CHRYSLER_ADDR(LKAS_COMMAND)) {
|
|
int start_byte = (chrysler_platform == CHRYSLER_PACIFICA) ? 0 : 1;
|
|
int desired_torque = ((msg->data[start_byte] & 0x7U) << 8) | msg->data[start_byte + 1];
|
|
desired_torque -= 1024;
|
|
|
|
const TorqueSteeringLimits limits = (chrysler_platform == CHRYSLER_PACIFICA) ? CHRYSLER_STEERING_LIMITS :
|
|
(chrysler_platform == CHRYSLER_RAM_DT) ? CHRYSLER_RAM_DT_STEERING_LIMITS : CHRYSLER_RAM_HD_STEERING_LIMITS;
|
|
|
|
bool steer_req = (chrysler_platform == CHRYSLER_PACIFICA) ? GET_BIT(msg, 4U) : (msg->data[3] & 0x7U) == 2U;
|
|
if (steer_torque_cmd_checks(desired_torque, steer_req, limits)) {
|
|
tx = false;
|
|
}
|
|
}
|
|
|
|
// FORCE CANCEL: only the cancel button press is allowed
|
|
if (msg->addr == CHRYSLER_ADDR(CRUISE_BUTTONS)) {
|
|
const bool is_cancel = msg->data[0] == 1U;
|
|
const bool is_accel = msg->data[0] == 0x04U;
|
|
const bool is_decel = msg->data[0] == 0x08U;
|
|
const bool is_resume = msg->data[0] == 0x10U;
|
|
const bool allowed = is_cancel || ((is_resume || is_accel || is_decel) && controls_allowed);
|
|
if (!allowed) {
|
|
tx = false;
|
|
}
|
|
}
|
|
|
|
return tx;
|
|
}
|
|
|
|
static safety_config chrysler_init(uint16_t param) {
|
|
const uint32_t CHRYSLER_PARAM_RAM_DT = 1U; // set for Ram DT platform
|
|
|
|
static RxCheck chrysler_ram_dt_rx_checks[] = {
|
|
{.msg = {{CHRYSLER_RAM_DT_EPS_2, 0, 8, 100U, .max_counter = 15U, .ignore_quality_flag = true}, { 0 }, { 0 }}},
|
|
{.msg = {{CHRYSLER_RAM_DT_ESP_1, 0, 8, 50U, .max_counter = 15U, .ignore_quality_flag = true}, { 0 }, { 0 }}},
|
|
{.msg = {{CHRYSLER_RAM_DT_ESP_8, 0, 8, 50U, .max_counter = 15U, .ignore_quality_flag = true}, { 0 }, { 0 }}},
|
|
{.msg = {{CHRYSLER_RAM_DT_ECM_5, 0, 8, 50U, .max_counter = 15U, .ignore_quality_flag = true}, { 0 }, { 0 }}},
|
|
{.msg = {{CHRYSLER_RAM_DT_DAS_3, 2, 8, 50U, .max_counter = 15U, .ignore_quality_flag = true}, { 0 }, { 0 }}},
|
|
{.msg = {{CHRYSLER_RAM_DT_Center_Stack_2, 0, 8, 1U, .ignore_checksum = true, .ignore_counter = true, .ignore_quality_flag = true}, { 0 }, { 0 }}},
|
|
};
|
|
|
|
static RxCheck chrysler_rx_checks[] = {
|
|
{.msg = {{CHRYSLER_EPS_2, 0, 8, 100U, .max_counter = 15U, .ignore_quality_flag = true}, { 0 }, { 0 }}},
|
|
{.msg = {{CHRYSLER_ESP_1, 0, 8, 50U, .max_counter = 15U, .ignore_quality_flag = true}, { 0 }, { 0 }}},
|
|
{.msg = {{514, 0, 8, 100U, .ignore_checksum = true, .ignore_counter = true, .ignore_quality_flag = true}, { 0 }, { 0 }}},
|
|
{.msg = {{CHRYSLER_ECM_5, 0, 8, 50U, .max_counter = 15U, .ignore_quality_flag = true}, { 0 }, { 0 }}},
|
|
{.msg = {{CHRYSLER_DAS_3, 0, 8, 50U, .max_counter = 15U, .ignore_quality_flag = true}, { 0 }, { 0 }}},
|
|
{.msg = {{CHRYSLER_TRACTION_BUTTON, 0, 8, 1U, .ignore_checksum = true, .ignore_counter = true, .ignore_quality_flag = true}, { 0 }, { 0 }}},
|
|
};
|
|
|
|
static const CanMsg CHRYSLER_TX_MSGS[] = {
|
|
{CHRYSLER_CRUISE_BUTTONS, 0, 3, .check_relay = false},
|
|
{CHRYSLER_LKAS_COMMAND, 0, 6, .check_relay = true},
|
|
{CHRYSLER_DAS_6, 0, 8, .check_relay = true},
|
|
{CHRYSLER_LKAS_HEARTBIT, 0, 5, .check_relay = true},
|
|
};
|
|
|
|
static const CanMsg CHRYSLER_RAM_DT_TX_MSGS[] = {
|
|
{CHRYSLER_RAM_DT_CRUISE_BUTTONS, 2, 3, .check_relay = false},
|
|
{CHRYSLER_RAM_DT_LKAS_COMMAND, 0, 8, .check_relay = true},
|
|
{CHRYSLER_RAM_DT_DAS_6, 0, 8, .check_relay = true},
|
|
};
|
|
|
|
#ifdef ALLOW_DEBUG
|
|
static RxCheck chrysler_ram_hd_rx_checks[] = {
|
|
{.msg = {{CHRYSLER_RAM_HD_EPS_2, 0, 8, 100U, .max_counter = 15U, .ignore_quality_flag = true}, { 0 }, { 0 }}},
|
|
{.msg = {{CHRYSLER_RAM_HD_ESP_1, 0, 8, 50U, .max_counter = 15U, .ignore_quality_flag = true}, { 0 }, { 0 }}},
|
|
{.msg = {{CHRYSLER_RAM_HD_ESP_8, 0, 8, 50U, .max_counter = 15U, .ignore_quality_flag = true}, { 0 }, { 0 }}},
|
|
{.msg = {{CHRYSLER_RAM_HD_ECM_5, 0, 8, 50U, .max_counter = 15U, .ignore_quality_flag = true}, { 0 }, { 0 }}},
|
|
{.msg = {{CHRYSLER_RAM_HD_DAS_3, 2, 8, 50U, .max_counter = 15U, .ignore_quality_flag = true}, { 0 }, { 0 }}},
|
|
{.msg = {{CHRYSLER_RAM_HD_Center_Stack_2, 0, 8, 1U, .ignore_checksum = true, .ignore_counter = true, .ignore_quality_flag = true}, { 0 }, { 0 }}},
|
|
};
|
|
|
|
static const CanMsg CHRYSLER_RAM_HD_TX_MSGS[] = {
|
|
{CHRYSLER_RAM_HD_CRUISE_BUTTONS, 2, 3, .check_relay = false},
|
|
{CHRYSLER_RAM_HD_LKAS_COMMAND, 0, 8, .check_relay = true},
|
|
{CHRYSLER_RAM_HD_DAS_6, 0, 8, .check_relay = true},
|
|
};
|
|
|
|
const uint32_t CHRYSLER_PARAM_RAM_HD = 2U; // set for Ram HD platform
|
|
bool enable_ram_hd = GET_FLAG(param, CHRYSLER_PARAM_RAM_HD);
|
|
#endif
|
|
|
|
safety_config ret;
|
|
|
|
bool enable_ram_dt = GET_FLAG(param, CHRYSLER_PARAM_RAM_DT);
|
|
|
|
if (enable_ram_dt) {
|
|
chrysler_platform = CHRYSLER_RAM_DT;
|
|
ret = BUILD_SAFETY_CFG(chrysler_ram_dt_rx_checks, CHRYSLER_RAM_DT_TX_MSGS);
|
|
#ifdef ALLOW_DEBUG
|
|
} else if (enable_ram_hd) {
|
|
chrysler_platform = CHRYSLER_RAM_HD;
|
|
ret = BUILD_SAFETY_CFG(chrysler_ram_hd_rx_checks, CHRYSLER_RAM_HD_TX_MSGS);
|
|
#endif
|
|
} else {
|
|
chrysler_platform = CHRYSLER_PACIFICA;
|
|
ret = BUILD_SAFETY_CFG(chrysler_rx_checks, CHRYSLER_TX_MSGS);
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
const safety_hooks chrysler_hooks = {
|
|
.init = chrysler_init,
|
|
.rx = chrysler_rx_hook,
|
|
.tx = chrysler_tx_hook,
|
|
.get_counter = chrysler_get_counter,
|
|
.get_checksum = chrysler_get_checksum,
|
|
.compute_checksum = chrysler_compute_checksum,
|
|
};
|