big refactoring: J1939, log output, state machine bug fixes
This commit is contained in:
@@ -0,0 +1,45 @@
|
||||
#include "load.h"
|
||||
#include "board.h"
|
||||
#include "debug.h"
|
||||
#include "connector.h"
|
||||
|
||||
#define COOLDOWN_TIME 60000
|
||||
|
||||
void LOAD_Init(){
|
||||
RELAY_Write(RELAY_1, 0);
|
||||
RELAY_Write(RELAY_2, 0);
|
||||
RELAY_Write(RELAY_3, 0);
|
||||
RELAY_Write(RELAY_4, 0);
|
||||
RELAY_Write(RELAY_5, 0);
|
||||
}
|
||||
|
||||
void LOAD_Task(){
|
||||
static uint32_t load_tick = 0;
|
||||
if(CONN[0].enableLoad || CONN[1].enableLoad){
|
||||
load_tick = HAL_GetTick();
|
||||
}
|
||||
|
||||
if((HAL_GetTick() - load_tick < COOLDOWN_TIME) && (load_tick!=0)){
|
||||
RELAY_Write(RELAY_1, 1);
|
||||
}else{
|
||||
RELAY_Write(RELAY_1, 0);
|
||||
}
|
||||
|
||||
|
||||
if(CONN[0].enableLoad){
|
||||
RELAY_Write(RELAY_2, 1);
|
||||
}else{
|
||||
RELAY_Write(RELAY_2, 0);
|
||||
}
|
||||
if(CONN[1].enableLoad){
|
||||
RELAY_Write(RELAY_3, 1);
|
||||
}else{
|
||||
RELAY_Write(RELAY_3, 0);
|
||||
}
|
||||
|
||||
// if(CONN[0].enableLoad && CONN[1].enableLoad){ // объединение нагрузок
|
||||
// RELAY_Write(RELAY_4, 0);
|
||||
// }else{
|
||||
// RELAY_Write(RELAY_4, 1);
|
||||
// }
|
||||
}
|
||||
Reference in New Issue
Block a user