FaSTTUBe/ams-master-23
56
2
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Discharge if SDC is open and TS_Activate is sent

Browse Source 
If we never leave TS_INACTIVE, the ABX keeps sending TS_Activate, and we
activate the TS as soon as the SDC is closed.
This commit is contained in:
Jasper Blanckenburg 2023-06-13 20:49:43 +02:00
parent 6d6c1c1f15
commit 78fe61e231
1 changed files with 14 additions and 6 deletions

12
Core/Src/ts_state_machine.c

@ -51,12 +51,20 @@ void ts_sm_update() {
} }
TSState ts_sm_update_inactive() { TSState ts_sm_update_inactive() {
if (ts_state.target_state == TS_ACTIVE && sdc_closed) { if (ts_state.target_state == TS_ACTIVE) {
if (sdc_closed) {
precharge_95_reached_timestamp = 0; precharge_95_reached_timestamp = 0;
return TS_PRECHARGE; return TS_PRECHARGE;
} else if (ts_state.target_state == TS_CHARGING && sdc_closed) { } else {
return TS_DISCHARGE;
}
} else if (ts_state.target_state == TS_CHARGING) {
if (sdc_closed) {
charging_check_timestamp = HAL_GetTick(); charging_check_timestamp = HAL_GetTick();
return TS_CHARGING_CHECK; return TS_CHARGING_CHECK;
} else {
return TS_DISCHARGE;
}
} }
return TS_INACTIVE; return TS_INACTIVE;