|
|
|
@ -215,7 +215,7 @@ static unsigned char *AppStateString(AppStateType state) { |
|
|
|
static void StateMachine(bool buttonPress) { |
|
|
|
static void StateMachine(bool buttonPress) { |
|
|
|
#if PL_CONFIG_USE_LINE_SENSOR |
|
|
|
#if PL_CONFIG_USE_LINE_SENSOR |
|
|
|
static uint8_t cnt; |
|
|
|
static uint8_t cnt; |
|
|
|
static uint8_t mazeFailure; |
|
|
|
// static uint8_t mazeFailure;
|
|
|
|
static uint8_t presentCnt; |
|
|
|
static uint8_t presentCnt; |
|
|
|
#endif |
|
|
|
#endif |
|
|
|
// TODO: send appstate via Mqtt
|
|
|
|
// TODO: send appstate via Mqtt
|
|
|
|
@ -368,7 +368,7 @@ static void StateMachine(bool buttonPress) { |
|
|
|
// send to mqtt AUTO
|
|
|
|
// send to mqtt AUTO
|
|
|
|
// SHELL_SendString((unsigned char*)"AUTO!!!\r\n");
|
|
|
|
// SHELL_SendString((unsigned char*)"AUTO!!!\r\n");
|
|
|
|
|
|
|
|
|
|
|
|
mazeFailure = 0; |
|
|
|
// mazeFailure = 0;
|
|
|
|
MAZE_ResetPresentCount(); |
|
|
|
MAZE_ResetPresentCount(); |
|
|
|
presentCnt = 0; |
|
|
|
presentCnt = 0; |
|
|
|
MAZE_ClearSolution(); |
|
|
|
MAZE_ClearSolution(); |
|
|
|
@ -388,7 +388,7 @@ static void StateMachine(bool buttonPress) { |
|
|
|
McuShell_SendStr((unsigned char*)"mqtt publish \"/mobile/status/mode/\" \"FINAL\"\r\n", McuESP32_GetTxToESPStdio()->stdOut); |
|
|
|
McuShell_SendStr((unsigned char*)"mqtt publish \"/mobile/status/mode/\" \"FINAL\"\r\n", McuESP32_GetTxToESPStdio()->stdOut); |
|
|
|
// McuShell_SendStr((unsigned char*)"\r\n", McuESP32_GetTxToESPStdio()->stdOut);
|
|
|
|
// McuShell_SendStr((unsigned char*)"\r\n", McuESP32_GetTxToESPStdio()->stdOut);
|
|
|
|
appState = APP_STATE_IDLE; |
|
|
|
appState = APP_STATE_IDLE; |
|
|
|
mazeFailure=0; |
|
|
|
// mazeFailure=0;
|
|
|
|
}else if(!LF_IsFollowing() && !MAZE_IsSolved()){// && mazeFailure < 5){
|
|
|
|
}else if(!LF_IsFollowing() && !MAZE_IsSolved()){// && mazeFailure < 5){
|
|
|
|
// failed
|
|
|
|
// failed
|
|
|
|
// mazeFailure++;
|
|
|
|
// mazeFailure++;
|
|
|
|
|