mirror of
https://github.com/dalathegreat/Battery-Emulator.git
synced 2025-10-03 09:49:32 +02:00
Send correct data in 441 message
This commit is contained in:
parent
10a60abd1a
commit
0f647978fa
1 changed files with 21 additions and 4 deletions
|
@ -136,6 +136,16 @@ uint16_t estimateSOCstandard(uint16_t packVoltage) { // Linear interpolation fu
|
||||||
return 0; // Default return for safety, should never reach here
|
return 0; // Default return for safety, should never reach here
|
||||||
}
|
}
|
||||||
|
|
||||||
|
uint8_t compute441Checksum(const uint8_t* u8) // Computes the 441 checksum byte
|
||||||
|
{
|
||||||
|
int sum = 0;
|
||||||
|
for (int i = 0; i < 7; ++i) {
|
||||||
|
sum += u8[i];
|
||||||
|
}
|
||||||
|
uint8_t lsb = static_cast<uint8_t>(sum & 0xFF);
|
||||||
|
return static_cast<uint8_t>(~lsb & 0xFF);
|
||||||
|
}
|
||||||
|
|
||||||
void BydAttoBattery::
|
void BydAttoBattery::
|
||||||
update_values() { //This function maps all the values fetched via CAN to the correct parameters used for modbus
|
update_values() { //This function maps all the values fetched via CAN to the correct parameters used for modbus
|
||||||
|
|
||||||
|
@ -532,10 +542,17 @@ void BydAttoBattery::transmit_can(unsigned long currentMillis) {
|
||||||
}
|
}
|
||||||
|
|
||||||
if (counter_100ms > 3) {
|
if (counter_100ms > 3) {
|
||||||
ATTO_3_441.data.u8[4] = 0x9D;
|
if (battery_voltage > 0){
|
||||||
ATTO_3_441.data.u8[5] = 0x01;
|
ATTO_3_441.data.u8[4] = (uint8_t)(battery_voltage - 1);
|
||||||
ATTO_3_441.data.u8[6] = 0xFF;
|
ATTO_3_441.data.u8[5] = ((battery_voltage - 1) >> 8);
|
||||||
ATTO_3_441.data.u8[7] = 0xF5;
|
ATTO_3_441.data.u8[6] = 0xFF;
|
||||||
|
ATTO_3_441.data.u8[7] = compute441Checksum(ATTO_3_441.data.u8);
|
||||||
|
} else {
|
||||||
|
ATTO_3_441.data.u8[4] = 0x0C;
|
||||||
|
ATTO_3_441.data.u8[5] = 0x00;
|
||||||
|
ATTO_3_441.data.u8[6] = 0xFF;
|
||||||
|
ATTO_3_441.data.u8[7] = 0x87;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
transmit_can_frame(&ATTO_3_441);
|
transmit_can_frame(&ATTO_3_441);
|
||||||
|
|
Loading…
Add table
Add a link
Reference in a new issue