diff --git a/ADIS_Sumo/Sumo/Application.c b/ADIS_Sumo/Sumo/Application.c index 5952c52..b192c34 100644 --- a/ADIS_Sumo/Sumo/Application.c +++ b/ADIS_Sumo/Sumo/Application.c @@ -366,16 +366,18 @@ static void StateMachine(bool buttonPress) { case APP_STATE_MANUAL_MOVE: if(REF_GetLineKind(REF_LINE_KIND_MODE_MAZE) == REF_LINE_STRAIGHT){ // send to mqtt AUTO - SHELL_SendString((unsigned char*)"AUTO!!!\r\n"); - appState = APP_STATE_AUTO; +// SHELL_SendString((unsigned char*)"AUTO!!!\r\n"); + mazeFailure = 0; MAZE_ResetPresentCount(); presentCnt = 0; MAZE_ClearSolution(); LF_StartFollowing(); - BUZ_Beep(1000, 1000); +// BUZ_Beep(2000, 1000); + BUZ_PlayTune(BUZ_TUNE_WELCOME); McuShell_SendStr((unsigned char*)"mqtt publish \"/mobile/status/mode/\" \"AUTO\"\r\n", McuESP32_GetTxToESPStdio()->stdOut); -// McuShell_SendStr((unsigned char*)"\r\n", McuESP32_GetTxToESPStdio()->stdOut); + appState = APP_STATE_AUTO; +// McuShell_SendStr((unsigned char*)"\r\n", McuESP32_GetTxToESPStdio()->stdOut); } vTaskDelay(pdMS_TO_TICKS(10)); break;