FaSTTUBe/mv-bms
56
1
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

added sm_test_cycle_states();

Browse Source
This commit is contained in:
Hamza 2024-05-28 19:43:24 +02:00
parent a0e55c0f44
commit cb4b5cb53e
2 changed files with 35 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
Core/Inc/state_machine.h
View File

@ -5,6 +5,9 @@
#include <stdbool.h> #include <stdbool.h>
#include "ADBMS_LL_Driver.h" #include "ADBMS_LL_Driver.h"
#include "AMS_HighLevel.h" #include "AMS_HighLevel.h"
#include "PWM_control.h"
#include "TMP1075.h"
#include <math.h>
// Minimum vehicle side voltage to exit precharge // Minimum vehicle side voltage to exit precharge
#define MIN_VEHICLE_SIDE_VOLTAGE 150000 // mV #define MIN_VEHICLE_SIDE_VOLTAGE 150000 // mV
@ -87,4 +90,6 @@ void sm_handle_ams_in(const uint8 *data);
void sm_check_errors(); void sm_check_errors();
void sm_set_error(ErrorKind error_kind, bool is_errored); void sm_set_error(ErrorKind error_kind, bool is_errored);
void sm_test_cycle_states();
#endif /* "INC_STATE_MACHINE_H" */ #endif /* "INC_STATE_MACHINE_H" */

36
Core/Src/state_machine.c
View File

@ -1,11 +1,8 @@
#include "state_machine.h" #include "state_machine.h"
#include "ADBMS_LL_Driver.h" #include "stm32f3xx_hal.h"
#include "TMP1075.h"
#include "common_defs.h"
#include <math.h>
StateHandle state; StateHandle state;
static int16_t timestamp; static uint32_t timestamp;
void sm_init(){ void sm_init(){
state.current_state = STATE_INACTIVE; state.current_state = STATE_INACTIVE;
@ -16,7 +13,7 @@ void sm_init(){
void sm_update(){ void sm_update(){
RELAY_BAT_SIDE_VOLTAGE = module.auxVoltages[0]; RELAY_BAT_SIDE_VOLTAGE = module.auxVoltages[0];
RELAY_ESC_SIDE_VOLTAGE = module.auxVoltages[1]; RELAY_ESC_SIDE_VOLTAGE = module.auxVoltages[1];
CURRENT_MEASUREMENT_VOLTAGE = module.auxVoltages[2]; CURRENT_MEASUREMENT = module.auxVoltages[2];
switch (state.current_state) { switch (state.current_state) {
case STATE_INACTIVE: case STATE_INACTIVE:
@ -232,3 +229,30 @@ void sm_check_errors(){
state.error_source = (1 << 10); state.error_source = (1 << 10);
} }
} }
void sm_test_cycle_states(){
if (timestamp > HAL_GetTick())
return;
switch (state.current_state) {
case STATE_INACTIVE:
state.current_state = STATE_PRECHARGE;
timestamp = HAL_GetTick() + 10000;
return;
case STATE_PRECHARGE:
state.current_state = STATE_READY;
timestamp = HAL_GetTick() + 10000;
return;
case STATE_READY:
state.current_state = STATE_ACTIVE;
timestamp = HAL_GetTick() + 10000;
return;
case STATE_ACTIVE:
state.current_state = STATE_DISCHARGE;
timestamp = HAL_GetTick() + 10000;
return;
case STATE_DISCHARGE:
state.current_state = STATE_INACTIVE;
timestamp = HAL_GetTick() + 10000;
return;
}
}