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

added state_machine.c

Browse Source
This commit is contained in:
Hamza Tamim
2024-05-23 19:08:23 +03:00
parent a3e7c2c266
commit 61c8d173a1
3 changed files with 217 additions and 10 deletions
Download Patch File Download Diff File Expand all files Collapse all files

10
Core/Src/main.c
View File

@ -121,9 +121,6 @@ int main(void)
AMS_Init(&hspi1);
ams_can_init(&hcan);
bool relay_actual = false;
bool relay_target = true;
uint32_t target_time = HAL_GetTick() + 10000;
/* USER CODE END 2 */
@ -142,13 +139,6 @@ int main(void)
ams_can_send_error();
}
ams_can_send_log();
if (HAL_GetTick() >= target_time) {
HAL_GPIO_WritePin(RELAY_EN_GPIO_Port, RELAY_EN_Pin, relay_target ? GPIO_PIN_SET : GPIO_PIN_RESET);
HAL_GPIO_WritePin(STATUS_LED_R_GPIO_Port, STATUS_LED_R_Pin, relay_target ? GPIO_PIN_RESET : GPIO_PIN_SET);
target_time = HAL_GetTick() + 10000;
relay_target = !relay_target;
}
}
/* USER CODE END 3 */
}

146
Core/Src/state_machine.c Normal file
View File

@ -0,0 +1,146 @@
#include "state_machine.h"
StateHandle state;
void sm_init(){
state.current_state = INACTIVE;
state.target_state = INACTIVE;
state.error_source = 0;
}
void sm_update(){
if (state.error_source) {
state.current_state = ERROR;
}
switch (state.current_state) {
case INACTIVE:
//state.current_state = sm_update_inactive(); moniter only
break;
case PRECHARGE:
//state.current_state = sm_update_precharge(); set PRECHARGE and turn on cooling at 50% or such
break;
case READY:
//state.current_state = ; keep cooling at 50%, get ready to turn on powerground
break;
case ACTIVE:
//state.current_state = sm_update_precharge(); set PRECHARGE and turn on cooling at 50% or such
break;
case DISCHARGE:
//state.current_state = sm_update_discharge(); // open the main relay, keep PRECHARGE closed
break;
case CHARGING:
//state.current_state = sm_update_charging(); // turn on cooling if needed,
break;
case ERROR:
//state.current_state = sm_update_error(); // enter the correct ERROR state
break;
case WARNING:
//state.current_state = sm_update_error(); // send warnings through CAN
break;
}
sm_set_relay_positions(state.current_state);
status_led_state(state.current_state, (ErrorKind) state.error_type);
}
State sm_update_inactive(){
switch (state.target_state) {
case PRECHARGE:
if ()
break;
case CHARGING:
break;
}
return INACTIVE;
}
State sm_update_precharge(){
switch (state.target_state) {
case INACTIVE:
break;
case READY:
break;
case DISCHARGE:
break;
}
return PRECHARGE;
}
State sm_update_ready(){
switch (state.target_state) {
case ACTIVE:
break;
case DISCHARGE:
break;
}
return READY;
}
State sm_update_active(){
switch (state.target_state) {
case READY:
break;
case DISCHARGE:
break;
}
return ACTIVE;
}
State sm_update_discharge(){
switch (state.target_state) {
case INACTIVE:
break;
case PRECHARGE:
break;
}
return DISCHARGE;
}
State sm_update_charging(){
switch (state.target_state) {
case INACTIVE:
break;
case DISCHARGE:
break;
}
return CHARGING;
}
State sm_update_error(){
switch (state.target_state) {
case INACTIVE:
break;
case DISCHARGE:
break;
}
return ERROR;
}
void sm_set_relay_positions(State state){
return;
}
void sm_set_relay(Relay relay, int closed){
static int closed = 0;
static int precharge_closed = 0;
GPIO_PinState state = closed ? GPIO_PIN_SET : GPIO_PIN_RESET;
switch (relay) {
case RELAY_POS:
ts_sm_check_close_wait(&closed, closed);
HAL_GPIO_WritePin(RELAY_EN_GPIO_Port, RELAY_EN_Pin, state);
break;
case RELAY_PRECHARGE:
ts_sm_check_close_wait(&precharge_closed, closed);
HAL_GPIO_WritePin(PRECHARGE_EN_GPIO_Port, PRECHARGE_EN_Pin, state);
break;
}
}
//void sm_check_close_wait(int *is_closed, int should_close);
//void sm_handle_ams_in(const uint8_t *data);
//void sm_set_error(ErrorKind error_kind, bool is_errored);