mirror of
https://github.com/dalathegreat/Battery-Emulator.git
synced 2025-10-05 10:49:42 +02:00
Add active PID polling for cellvoltages
This commit is contained in:
Daniel Öster
parent
37e2308967
commit
0a725f433c
1 changed files with 213 additions and 4 deletions
|
|
@ -18,11 +18,15 @@ TODO: Check if CRC function works like it should. This enables checking for corr
|
||||||
/* Do not change code below unless you are sure what you are doing */
|
/* Do not change code below unless you are sure what you are doing */
|
||||||
static unsigned long previousMillis10 = 0; // will store last time a 10ms CAN Message was send
|
static unsigned long previousMillis10 = 0; // will store last time a 10ms CAN Message was send
|
||||||
static unsigned long previousMillis100 = 0; // will store last time a 100ms CAN Message was send
|
static unsigned long previousMillis100 = 0; // will store last time a 100ms CAN Message was send
|
||||||
|
static unsigned long previousMillis500 = 0; // will store last time a 500ms CAN Message was send
|
||||||
|
static uint8_t poll_data_pid = 0;
|
||||||
|
|
||||||
static uint16_t SOC_BMS = 0;
|
static uint16_t SOC_BMS = 0;
|
||||||
static uint16_t batterySOH = 1000;
|
static uint16_t batterySOH = 1000;
|
||||||
static uint16_t CellVoltMax_mV = 3700;
|
static uint16_t CellVoltMax_mV = 3700;
|
||||||
static uint16_t CellVoltMin_mV = 3700;
|
static uint16_t CellVoltMin_mV = 3700;
|
||||||
|
static uint8_t CellVmaxNo = 0;
|
||||||
|
static uint8_t CellVminNo = 0;
|
||||||
static uint16_t allowedDischargePower = 0;
|
static uint16_t allowedDischargePower = 0;
|
||||||
static uint16_t allowedChargePower = 0;
|
static uint16_t allowedChargePower = 0;
|
||||||
static uint16_t batteryVoltage = 0;
|
static uint16_t batteryVoltage = 0;
|
||||||
|
|
@ -33,6 +37,7 @@ static int16_t batteryAmps = 0;
|
||||||
static uint8_t counter_200 = 0;
|
static uint8_t counter_200 = 0;
|
||||||
static uint8_t checksum_200 = 0;
|
static uint8_t checksum_200 = 0;
|
||||||
static uint8_t StatusBattery = 0;
|
static uint8_t StatusBattery = 0;
|
||||||
|
static uint16_t cellvoltages_mv[96];
|
||||||
|
|
||||||
CAN_frame_t SANTAFE_200 = {.FIR = {.B =
|
CAN_frame_t SANTAFE_200 = {.FIR = {.B =
|
||||||
{
|
{
|
||||||
|
|
@ -62,11 +67,27 @@ CAN_frame_t SANTAFE_523 = {.FIR = {.B =
|
||||||
}},
|
}},
|
||||||
.MsgID = 0x523,
|
.MsgID = 0x523,
|
||||||
.data = {0x60, 0x00, 0x60, 0, 0, 0, 0, 0}};
|
.data = {0x60, 0x00, 0x60, 0, 0, 0, 0, 0}};
|
||||||
|
CAN_frame_t SANTAFE_7E4_poll = {.FIR = {.B =
|
||||||
|
{
|
||||||
|
.DLC = 8,
|
||||||
|
.FF = CAN_frame_std,
|
||||||
|
}},
|
||||||
|
.MsgID = 0x7E4, //Polling frame, 0x22 01 0X
|
||||||
|
.data = {0x03, 0x22, 0x01, 0x01, 0x00, 0x00, 0x00, 0x00}};
|
||||||
|
CAN_frame_t SANTAFE_7E4_ack = {.FIR = {.B =
|
||||||
|
{
|
||||||
|
.DLC = 8,
|
||||||
|
.FF = CAN_frame_std,
|
||||||
|
}},
|
||||||
|
.MsgID = 0x7E4, //Ack frame, correct PID is returned. Flow control message
|
||||||
|
.data = {0x30, 0x00, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00}};
|
||||||
|
|
||||||
void update_values_battery() { //This function maps all the values fetched via CAN to the correct parameters used for modbus
|
void update_values_battery() { //This function maps all the values fetched via CAN to the correct parameters used for modbus
|
||||||
|
|
||||||
datalayer.battery.status.real_soc = SOC_BMS * 10;
|
datalayer.battery.status.real_soc = SOC_BMS * 10;
|
||||||
|
|
||||||
|
datalayer.battery.status.soh_pptt = (batterySOH * 10); //Increase decimals from 100.0% -> 100.00%
|
||||||
|
|
||||||
datalayer.battery.status.voltage_dV = batteryVoltage;
|
datalayer.battery.status.voltage_dV = batteryVoltage;
|
||||||
|
|
||||||
datalayer.battery.status.current_dA = batteryAmps;
|
datalayer.battery.status.current_dA = batteryAmps;
|
||||||
|
|
@ -82,6 +103,10 @@ void update_values_battery() { //This function maps all the values fetched via
|
||||||
datalayer.battery.status.active_power_W =
|
datalayer.battery.status.active_power_W =
|
||||||
((datalayer.battery.status.voltage_dV * datalayer.battery.status.current_dA) / 100);
|
((datalayer.battery.status.voltage_dV * datalayer.battery.status.current_dA) / 100);
|
||||||
|
|
||||||
|
datalayer.battery.status.cell_max_voltage_mV = CellVoltMax_mV;
|
||||||
|
|
||||||
|
datalayer.battery.status.cell_min_voltage_mV = CellVoltMin_mV;
|
||||||
|
|
||||||
if (temperatureMax > temperatureMin) {
|
if (temperatureMax > temperatureMin) {
|
||||||
datalayer.battery.status.temperature_min_dC = temperatureMin;
|
datalayer.battery.status.temperature_min_dC = temperatureMin;
|
||||||
|
|
||||||
|
|
@ -152,12 +177,169 @@ void receive_can_battery(CAN_frame_t rx_frame) {
|
||||||
datalayer.battery.status.CAN_battery_still_alive = CAN_STILL_ALIVE;
|
datalayer.battery.status.CAN_battery_still_alive = CAN_STILL_ALIVE;
|
||||||
temperatureMin = (rx_frame.data.u8[0] - 40);
|
temperatureMin = (rx_frame.data.u8[0] - 40);
|
||||||
break;
|
break;
|
||||||
|
case 0x7EC: //Data From polled PID group, BigEndian
|
||||||
|
switch (rx_frame.data.u8[0]) {
|
||||||
|
case 0x10: //"PID Header"
|
||||||
|
if (rx_frame.data.u8[4] == poll_data_pid) {
|
||||||
|
ESP32Can.CANWriteFrame(&SANTAFE_7E4_ack); //Send ack to BMS if the same frame is sent as polled
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
case 0x21: //First frame in PID group
|
||||||
|
if (poll_data_pid == 1) {
|
||||||
|
} else if (poll_data_pid == 2) {
|
||||||
|
cellvoltages_mv[0] = (rx_frame.data.u8[2] * 20);
|
||||||
|
cellvoltages_mv[1] = (rx_frame.data.u8[3] * 20);
|
||||||
|
cellvoltages_mv[2] = (rx_frame.data.u8[4] * 20);
|
||||||
|
cellvoltages_mv[3] = (rx_frame.data.u8[5] * 20);
|
||||||
|
cellvoltages_mv[4] = (rx_frame.data.u8[6] * 20);
|
||||||
|
cellvoltages_mv[5] = (rx_frame.data.u8[7] * 20);
|
||||||
|
} else if (poll_data_pid == 3) {
|
||||||
|
cellvoltages_mv[32] = (rx_frame.data.u8[2] * 20);
|
||||||
|
cellvoltages_mv[33] = (rx_frame.data.u8[3] * 20);
|
||||||
|
cellvoltages_mv[34] = (rx_frame.data.u8[4] * 20);
|
||||||
|
cellvoltages_mv[35] = (rx_frame.data.u8[5] * 20);
|
||||||
|
cellvoltages_mv[36] = (rx_frame.data.u8[6] * 20);
|
||||||
|
cellvoltages_mv[37] = (rx_frame.data.u8[7] * 20);
|
||||||
|
} else if (poll_data_pid == 4) {
|
||||||
|
cellvoltages_mv[64] = (rx_frame.data.u8[2] * 20);
|
||||||
|
cellvoltages_mv[65] = (rx_frame.data.u8[3] * 20);
|
||||||
|
cellvoltages_mv[66] = (rx_frame.data.u8[4] * 20);
|
||||||
|
cellvoltages_mv[67] = (rx_frame.data.u8[5] * 20);
|
||||||
|
cellvoltages_mv[68] = (rx_frame.data.u8[6] * 20);
|
||||||
|
cellvoltages_mv[69] = (rx_frame.data.u8[7] * 20);
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
case 0x22: //Second datarow in PID group
|
||||||
|
if (poll_data_pid == 2) {
|
||||||
|
cellvoltages_mv[6] = (rx_frame.data.u8[1] * 20);
|
||||||
|
cellvoltages_mv[7] = (rx_frame.data.u8[2] * 20);
|
||||||
|
cellvoltages_mv[8] = (rx_frame.data.u8[3] * 20);
|
||||||
|
cellvoltages_mv[9] = (rx_frame.data.u8[4] * 20);
|
||||||
|
cellvoltages_mv[10] = (rx_frame.data.u8[5] * 20);
|
||||||
|
cellvoltages_mv[11] = (rx_frame.data.u8[6] * 20);
|
||||||
|
cellvoltages_mv[12] = (rx_frame.data.u8[7] * 20);
|
||||||
|
} else if (poll_data_pid == 3) {
|
||||||
|
cellvoltages_mv[38] = (rx_frame.data.u8[1] * 20);
|
||||||
|
cellvoltages_mv[39] = (rx_frame.data.u8[2] * 20);
|
||||||
|
cellvoltages_mv[40] = (rx_frame.data.u8[3] * 20);
|
||||||
|
cellvoltages_mv[41] = (rx_frame.data.u8[4] * 20);
|
||||||
|
cellvoltages_mv[42] = (rx_frame.data.u8[5] * 20);
|
||||||
|
cellvoltages_mv[43] = (rx_frame.data.u8[6] * 20);
|
||||||
|
cellvoltages_mv[44] = (rx_frame.data.u8[7] * 20);
|
||||||
|
} else if (poll_data_pid == 4) {
|
||||||
|
cellvoltages_mv[70] = (rx_frame.data.u8[1] * 20);
|
||||||
|
cellvoltages_mv[71] = (rx_frame.data.u8[2] * 20);
|
||||||
|
cellvoltages_mv[72] = (rx_frame.data.u8[3] * 20);
|
||||||
|
cellvoltages_mv[73] = (rx_frame.data.u8[4] * 20);
|
||||||
|
cellvoltages_mv[74] = (rx_frame.data.u8[5] * 20);
|
||||||
|
cellvoltages_mv[75] = (rx_frame.data.u8[6] * 20);
|
||||||
|
cellvoltages_mv[76] = (rx_frame.data.u8[7] * 20);
|
||||||
|
} else if (poll_data_pid == 6) {
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
case 0x23: //Third datarow in PID group
|
||||||
|
if (poll_data_pid == 1) {
|
||||||
|
CellVoltMax_mV = (rx_frame.data.u8[7] * 20); //(volts *50) *20 =mV
|
||||||
|
} else if (poll_data_pid == 2) {
|
||||||
|
cellvoltages_mv[13] = (rx_frame.data.u8[1] * 20);
|
||||||
|
cellvoltages_mv[14] = (rx_frame.data.u8[2] * 20);
|
||||||
|
cellvoltages_mv[15] = (rx_frame.data.u8[3] * 20);
|
||||||
|
cellvoltages_mv[16] = (rx_frame.data.u8[4] * 20);
|
||||||
|
cellvoltages_mv[17] = (rx_frame.data.u8[5] * 20);
|
||||||
|
cellvoltages_mv[18] = (rx_frame.data.u8[6] * 20);
|
||||||
|
cellvoltages_mv[19] = (rx_frame.data.u8[7] * 20);
|
||||||
|
} else if (poll_data_pid == 3) {
|
||||||
|
cellvoltages_mv[45] = (rx_frame.data.u8[1] * 20);
|
||||||
|
cellvoltages_mv[46] = (rx_frame.data.u8[2] * 20);
|
||||||
|
cellvoltages_mv[47] = (rx_frame.data.u8[3] * 20);
|
||||||
|
cellvoltages_mv[48] = (rx_frame.data.u8[4] * 20);
|
||||||
|
cellvoltages_mv[49] = (rx_frame.data.u8[5] * 20);
|
||||||
|
cellvoltages_mv[50] = (rx_frame.data.u8[6] * 20);
|
||||||
|
cellvoltages_mv[51] = (rx_frame.data.u8[7] * 20);
|
||||||
|
} else if (poll_data_pid == 4) {
|
||||||
|
cellvoltages_mv[77] = (rx_frame.data.u8[1] * 20);
|
||||||
|
cellvoltages_mv[78] = (rx_frame.data.u8[2] * 20);
|
||||||
|
cellvoltages_mv[79] = (rx_frame.data.u8[3] * 20);
|
||||||
|
cellvoltages_mv[80] = (rx_frame.data.u8[4] * 20);
|
||||||
|
cellvoltages_mv[81] = (rx_frame.data.u8[5] * 20);
|
||||||
|
cellvoltages_mv[82] = (rx_frame.data.u8[6] * 20);
|
||||||
|
cellvoltages_mv[83] = (rx_frame.data.u8[7] * 20);
|
||||||
|
} else if (poll_data_pid == 5) {
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
case 0x24: //Fourth datarow in PID group
|
||||||
|
if (poll_data_pid == 1) {
|
||||||
|
CellVmaxNo = rx_frame.data.u8[1];
|
||||||
|
CellVminNo = rx_frame.data.u8[3];
|
||||||
|
CellVoltMin_mV = (rx_frame.data.u8[2] * 20); //(volts *50) *20 =mV
|
||||||
|
} else if (poll_data_pid == 2) {
|
||||||
|
cellvoltages_mv[20] = (rx_frame.data.u8[1] * 20);
|
||||||
|
cellvoltages_mv[21] = (rx_frame.data.u8[2] * 20);
|
||||||
|
cellvoltages_mv[22] = (rx_frame.data.u8[3] * 20);
|
||||||
|
cellvoltages_mv[23] = (rx_frame.data.u8[4] * 20);
|
||||||
|
cellvoltages_mv[24] = (rx_frame.data.u8[5] * 20);
|
||||||
|
cellvoltages_mv[25] = (rx_frame.data.u8[6] * 20);
|
||||||
|
cellvoltages_mv[26] = (rx_frame.data.u8[7] * 20);
|
||||||
|
} else if (poll_data_pid == 3) {
|
||||||
|
cellvoltages_mv[52] = (rx_frame.data.u8[1] * 20);
|
||||||
|
cellvoltages_mv[53] = (rx_frame.data.u8[2] * 20);
|
||||||
|
cellvoltages_mv[54] = (rx_frame.data.u8[3] * 20);
|
||||||
|
cellvoltages_mv[55] = (rx_frame.data.u8[4] * 20);
|
||||||
|
cellvoltages_mv[56] = (rx_frame.data.u8[5] * 20);
|
||||||
|
cellvoltages_mv[57] = (rx_frame.data.u8[6] * 20);
|
||||||
|
cellvoltages_mv[58] = (rx_frame.data.u8[7] * 20);
|
||||||
|
} else if (poll_data_pid == 4) {
|
||||||
|
cellvoltages_mv[84] = (rx_frame.data.u8[1] * 20);
|
||||||
|
cellvoltages_mv[85] = (rx_frame.data.u8[2] * 20);
|
||||||
|
cellvoltages_mv[86] = (rx_frame.data.u8[3] * 20);
|
||||||
|
cellvoltages_mv[87] = (rx_frame.data.u8[4] * 20);
|
||||||
|
cellvoltages_mv[88] = (rx_frame.data.u8[5] * 20);
|
||||||
|
cellvoltages_mv[89] = (rx_frame.data.u8[6] * 20);
|
||||||
|
cellvoltages_mv[90] = (rx_frame.data.u8[7] * 20);
|
||||||
|
} else if (poll_data_pid == 5) {
|
||||||
|
batterySOH = ((rx_frame.data.u8[2] << 8) + rx_frame.data.u8[3]);
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
case 0x25: //Fifth datarow in PID group
|
||||||
|
if (poll_data_pid == 2) {
|
||||||
|
cellvoltages_mv[27] = (rx_frame.data.u8[1] * 20);
|
||||||
|
cellvoltages_mv[28] = (rx_frame.data.u8[2] * 20);
|
||||||
|
cellvoltages_mv[29] = (rx_frame.data.u8[3] * 20);
|
||||||
|
cellvoltages_mv[30] = (rx_frame.data.u8[4] * 20);
|
||||||
|
cellvoltages_mv[31] = (rx_frame.data.u8[5] * 20);
|
||||||
|
} else if (poll_data_pid == 3) {
|
||||||
|
cellvoltages_mv[59] = (rx_frame.data.u8[1] * 20);
|
||||||
|
cellvoltages_mv[60] = (rx_frame.data.u8[2] * 20);
|
||||||
|
cellvoltages_mv[61] = (rx_frame.data.u8[3] * 20);
|
||||||
|
cellvoltages_mv[62] = (rx_frame.data.u8[4] * 20);
|
||||||
|
cellvoltages_mv[63] = (rx_frame.data.u8[5] * 20);
|
||||||
|
} else if (poll_data_pid == 4) {
|
||||||
|
cellvoltages_mv[91] = (rx_frame.data.u8[1] * 20);
|
||||||
|
cellvoltages_mv[92] = (rx_frame.data.u8[2] * 20);
|
||||||
|
cellvoltages_mv[93] = (rx_frame.data.u8[3] * 20);
|
||||||
|
cellvoltages_mv[94] = (rx_frame.data.u8[4] * 20);
|
||||||
|
cellvoltages_mv[95] = (rx_frame.data.u8[5] * 20);
|
||||||
|
|
||||||
|
//Map all cell voltages to the global array, we have sampled them all!
|
||||||
|
memcpy(datalayer.battery.status.cell_voltages_mV, cellvoltages_mv, 96 * sizeof(uint16_t));
|
||||||
|
} else if (poll_data_pid == 5) {
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
case 0x26: //Sixth datarow in PID group
|
||||||
|
break;
|
||||||
|
case 0x27: //Seventh datarow in PID group
|
||||||
|
break;
|
||||||
|
case 0x28: //Eighth datarow in PID group
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
break;
|
||||||
default:
|
default:
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
void send_can_battery() {
|
void send_can_battery() {
|
||||||
unsigned long currentMillis = millis();
|
unsigned long currentMillis = millis();
|
||||||
|
|
||||||
//Send 10ms message
|
//Send 10ms message
|
||||||
if (currentMillis - previousMillis10 >= INTERVAL_10_MS) {
|
if (currentMillis - previousMillis10 >= INTERVAL_10_MS) {
|
||||||
// Check if sending of CAN messages has been delayed too much.
|
// Check if sending of CAN messages has been delayed too much.
|
||||||
|
|
@ -185,12 +367,40 @@ void send_can_battery() {
|
||||||
counter_200 = 0;
|
counter_200 = 0;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
// Send 100ms CAN Message
|
// Send 100ms CAN Message
|
||||||
if (currentMillis - previousMillis100 >= INTERVAL_100_MS) {
|
if (currentMillis - previousMillis100 >= INTERVAL_100_MS) {
|
||||||
previousMillis100 = currentMillis;
|
previousMillis100 = currentMillis;
|
||||||
|
|
||||||
ESP32Can.CANWriteFrame(&SANTAFE_523);
|
ESP32Can.CANWriteFrame(&SANTAFE_523);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// Send 500ms CAN Message
|
||||||
|
if (currentMillis - previousMillis500 >= INTERVAL_500_MS) {
|
||||||
|
previousMillis500 = currentMillis;
|
||||||
|
|
||||||
|
//PID data is polled after last message sent from battery:
|
||||||
|
if (poll_data_pid >= 5) { //polling one of 5 PIDs at 100ms, resolution = 500ms
|
||||||
|
poll_data_pid = 0;
|
||||||
|
}
|
||||||
|
poll_data_pid++;
|
||||||
|
if (poll_data_pid == 1) {
|
||||||
|
SANTAFE_7E4_poll.data.u8[3] = 0x01;
|
||||||
|
ESP32Can.CANWriteFrame(&SANTAFE_7E4_poll);
|
||||||
|
} else if (poll_data_pid == 2) {
|
||||||
|
SANTAFE_7E4_poll.data.u8[3] = 0x01;
|
||||||
|
ESP32Can.CANWriteFrame(&SANTAFE_7E4_poll);
|
||||||
|
} else if (poll_data_pid == 3) {
|
||||||
|
SANTAFE_7E4_poll.data.u8[3] = 0x01;
|
||||||
|
ESP32Can.CANWriteFrame(&SANTAFE_7E4_poll);
|
||||||
|
} else if (poll_data_pid == 4) {
|
||||||
|
SANTAFE_7E4_poll.data.u8[3] = 0x01;
|
||||||
|
ESP32Can.CANWriteFrame(&SANTAFE_7E4_poll);
|
||||||
|
} else if (poll_data_pid == 5) {
|
||||||
|
SANTAFE_7E4_poll.data.u8[3] = 0x01;
|
||||||
|
ESP32Can.CANWriteFrame(&SANTAFE_7E4_poll);
|
||||||
|
}
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
uint8_t CalculateCRC8(CAN_frame_t rx_frame) {
|
uint8_t CalculateCRC8(CAN_frame_t rx_frame) {
|
||||||
|
|
@ -214,10 +424,9 @@ void setup_battery(void) { // Performs one time setup at startup
|
||||||
#ifdef DEBUG_VIA_USB
|
#ifdef DEBUG_VIA_USB
|
||||||
Serial.println("Hyundai Santa Fe PHEV battery selected");
|
Serial.println("Hyundai Santa Fe PHEV battery selected");
|
||||||
#endif
|
#endif
|
||||||
|
datalayer.battery.info.number_of_cells = 96;
|
||||||
datalayer.battery.info.max_design_voltage_dV =
|
datalayer.battery.info.max_design_voltage_dV = 4040;
|
||||||
4040; // 404.0V, over this, charging is not possible (goes into forced discharge)
|
datalayer.battery.info.min_design_voltage_dV = 2880;
|
||||||
datalayer.battery.info.min_design_voltage_dV = 3100; // 310.0V under this, discharging further is disabled
|
|
||||||
}
|
}
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
|
||||||
Loading…
Add table
Add a link
Reference in a new issue