fixed LEDs
This commit is contained in:
@ -141,18 +141,21 @@ int main(void)
|
||||
int br = 0, bg = 0, bb = 0;
|
||||
|
||||
if(acc_status.ams_status.sdc_closed == 1){
|
||||
if(acc_status.ams_status.ts_inactive){
|
||||
if(acc_status.ams_status.ts_state == TS_INACTIVE){
|
||||
r = g = 1;
|
||||
}
|
||||
if(acc_status.ams_status.ts_precharge){
|
||||
if(acc_status.ams_status.ts_state == TS_PRECHARGE){
|
||||
br = bg = 1;
|
||||
}
|
||||
if(acc_status.ams_status.ts_active){
|
||||
if(acc_status.ams_status.ts_state == TS_ACTIVE){
|
||||
g = 1;
|
||||
}
|
||||
if(acc_status.ams_status.ts_discharge){
|
||||
if(acc_status.ams_status.ts_state == TS_DISCHARGE){
|
||||
br = bb = 1;
|
||||
}
|
||||
if(acc_status.ams_status.ts_state == TS_ERROR){
|
||||
r = 1;
|
||||
}
|
||||
}
|
||||
else{
|
||||
b = r = 1;
|
||||
@ -162,7 +165,7 @@ int main(void)
|
||||
HAL_GPIO_WritePin(TSON_G_GPIO_Port, TSON_G_Pin, g);
|
||||
HAL_GPIO_WritePin(TSON_B_GPIO_Port, TSON_B_Pin, b);
|
||||
|
||||
if ((br || bg || bb) && ((HAL_GetTick() - blink_tick_tson) > 100u)) {
|
||||
if ((br || bg || bb) && ((HAL_GetTick() - blink_tick_tson) > 10u)) {
|
||||
HAL_GPIO_WritePin(TSON_R_GPIO_Port, TSON_R_Pin, br && blink_state);
|
||||
HAL_GPIO_WritePin(TSON_G_GPIO_Port, TSON_G_Pin, bg && blink_state);
|
||||
HAL_GPIO_WritePin(TSON_B_GPIO_Port, TSON_B_Pin, bb && blink_state);
|
||||
@ -172,7 +175,7 @@ int main(void)
|
||||
r = g = b = 0;
|
||||
br = bg = bb = 0;
|
||||
|
||||
if (acc_status.ams_status.ts_active) {
|
||||
if (acc_status.ams_status.ts_state == TS_ACTIVE) {
|
||||
if((r2d_progress == R2D_TS_ACTIVE) || (r2d_progress == R2D_TSMS) || (r2d_progress == R2D_NONE)){
|
||||
r = g = 1;
|
||||
}
|
||||
@ -191,7 +194,7 @@ int main(void)
|
||||
HAL_GPIO_WritePin(R2D_B_GPIO_Port, R2D_B_Pin, b);
|
||||
|
||||
|
||||
if ((br || bg || bb) && ((HAL_GetTick() - blink_tick_r2d) > 100u)) {
|
||||
if ((br || bg || bb) && ((HAL_GetTick() - blink_tick_r2d) > 10u)) {
|
||||
HAL_GPIO_WritePin(R2D_R_GPIO_Port, R2D_R_Pin, br && blink_state);
|
||||
HAL_GPIO_WritePin(R2D_G_GPIO_Port, R2D_G_Pin, bg && blink_state);
|
||||
HAL_GPIO_WritePin(R2D_B_GPIO_Port, R2D_B_Pin, bb && blink_state);
|
||||
|
||||
Reference in New Issue
Block a user