rusefi
/
bldc
mirror of https://github.com/rusefi/bldc.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

BMS balance state parse fix

This commit is contained in:
Benjamin Vedder 2020-10-22 09:26:02 +02:00
parent af7cd36cb8
commit c69032e882
1 changed files with 4 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
bms.c
View File

@ -182,11 +182,14 @@ bool bms_process_can_frame(uint32_t can_id, uint8_t *data8, int len, bool is_ext
m_values.can_id = id;
m_values.update_time = chVTGetSystemTimeX();
int cell_num = data8[0];
uint64_t bal_state_0 = buffer_get_uint32(data8, &ind);
bal_state_0 &= 0x00FFFFFF;
uint64_t bal_state_1 = buffer_get_uint32(data8, &ind);
uint64_t bal_state = bal_state_0 << 32 | bal_state_1;
ind = 0;
while (ind < (int)(sizeof(m_values.bal_state) / sizeof(bool)) && ind < 64) {
while (ind < (int)(sizeof(m_values.bal_state) / sizeof(bool)) && ind < cell_num) {
m_values.bal_state[ind] = (bal_state >> ind) & 1;
ind++;
}