From 9ce5bab9d0226e9fa352a88410b98ea2128ed8ff Mon Sep 17 00:00:00 2001 From: anidev Date: Wed, 23 Apr 2014 08:56:25 -0500 Subject: [PATCH] Changed auto to wait for hot goal before driving forward --- Autonomous.cpp | 12 ++++++------ 1 file changed, 6 insertions(+), 6 deletions(-) diff --git a/Autonomous.cpp b/Autonomous.cpp index aec5e4b..f762be1 100644 --- a/Autonomous.cpp +++ b/Autonomous.cpp @@ -116,8 +116,8 @@ void Autonomous::updateHighGoal() case BASIC_DRIVE: if(moveForward(DISTANCE)) { - printf("AUTO switch to IS_HOT\n"); - stage = IS_HOT; + printf("AUTO switch to SMART_FIRE\n"); + stage = SMART_FIRE; return; } break; @@ -132,16 +132,16 @@ void Autonomous::updateHighGoal() case FINE_AIM: if(tilt(HIGHGOAL_AUTOANGLE)) { - printf("AUTO switch to BASIC_DRIVE\n"); - stage = BASIC_DRIVE; + printf("AUTO switch to IS_HOT\n"); + stage = IS_HOT; return; } break; case IS_HOT: if (determineHot()) { printf("goal is hot\n"); - printf("AUTO switch to SMART_FIRE\n"); - stage=SMART_FIRE; + printf("AUTO switch to BASIC_DRIVE\n"); + stage=BASIC_DRIVE; return; } break;