added some testing tools
This commit is contained in:
@ -11,9 +11,9 @@ void sm_init(){
|
||||
}
|
||||
|
||||
void sm_update(){
|
||||
RELAY_BAT_SIDE_VOLTAGE = module.auxVoltages[0];
|
||||
RELAY_ESC_SIDE_VOLTAGE = module.auxVoltages[1];
|
||||
CURRENT_MEASUREMENT = module.auxVoltages[2];
|
||||
RELAY_BAT_SIDE_VOLTAGE = mV_from_ADBMS6830(module.auxVoltages[0]);
|
||||
RELAY_ESC_SIDE_VOLTAGE = mV_from_ADBMS6830(module.auxVoltages[1]);
|
||||
CURRENT_MEASUREMENT = mV_from_ADBMS6830(module.auxVoltages[2]);
|
||||
|
||||
switch (state.current_state) {
|
||||
case STATE_INACTIVE:
|
||||
@ -231,28 +231,37 @@ void sm_check_errors(){
|
||||
}
|
||||
|
||||
void sm_test_cycle_states(){
|
||||
RELAY_BAT_SIDE_VOLTAGE = module.auxVoltages[0];
|
||||
RELAY_ESC_SIDE_VOLTAGE = module.auxVoltages[1];
|
||||
CURRENT_MEASUREMENT = module.auxVoltages[2];
|
||||
sm_set_relay_positions(state.current_state);
|
||||
|
||||
if (timestamp > HAL_GetTick())
|
||||
return;
|
||||
switch (state.current_state) {
|
||||
case STATE_INACTIVE:
|
||||
state.current_state = STATE_PRECHARGE;
|
||||
timestamp = HAL_GetTick() + 10000;
|
||||
return;
|
||||
timestamp = HAL_GetTick() + 30000;
|
||||
PWM_powerground_control(0);
|
||||
break;
|
||||
case STATE_PRECHARGE:
|
||||
state.current_state = STATE_READY;
|
||||
timestamp = HAL_GetTick() + 10000;
|
||||
return;
|
||||
break;
|
||||
case STATE_READY:
|
||||
state.current_state = STATE_ACTIVE;
|
||||
timestamp = HAL_GetTick() + 10000;
|
||||
return;
|
||||
break;
|
||||
case STATE_ACTIVE:
|
||||
state.current_state = STATE_DISCHARGE;
|
||||
timestamp = HAL_GetTick() + 10000;
|
||||
return;
|
||||
PWM_powerground_control(1);
|
||||
break;
|
||||
case STATE_DISCHARGE:
|
||||
state.current_state = STATE_INACTIVE;
|
||||
timestamp = HAL_GetTick() + 10000;
|
||||
return;
|
||||
break;
|
||||
}
|
||||
|
||||
state.target_state = state.current_state;
|
||||
}
|
||||
Reference in New Issue
Block a user