team2059/dent
2
0
Fork 0
mirror of https://github.com/team2059/Dent synced 2024-12-18 20:52:29 -05:00
Code Issues Releases Wiki Activity

Updated autonomous

Browse Source
This commit is contained in:
Austen Adler 2015-02-24 15:03:59 -05:00
parent e6e616b08d
commit 3ec24179bc
1 changed files with 4 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
Commands/Autonomous/Autonomous.cpp
View File

@ -7,6 +7,7 @@
#include "Turn.h" #include "Turn.h"
#include "../Collector/RollIn.h" #include "../Collector/RollIn.h"
#include "CollectTote.h" #include "CollectTote.h"
#include "ReleaseTote.h"
Autonomous::Autonomous(int seq){ Autonomous::Autonomous(int seq){
//SmartDashboard::GetNumber("Auto Wait Time"); //SmartDashboard::GetNumber("Auto Wait Time");
switch(seq){ switch(seq){
@ -21,9 +22,10 @@ Autonomous::Autonomous(int seq){
AddSequential(new AutoDrive(SmartDashboard::GetNumber("Auto Zone Distance"), -0.75)); AddSequential(new AutoDrive(SmartDashboard::GetNumber("Auto Zone Distance"), -0.75));
break; break;
case 2: case 2:
// Get one tote and go to auto // Get one tote and go to Auto Zone (TM)
AddSequential(new CollectTote()); AddSequential(new CollectTote());
AddSequential(new Turn(90)); AddSequential(new Turn(90));
AddSequential(new ReleaseTote());
break; break;
case 3: case 3:
// Collect three totes, drive to Auto Zone (TM) // Collect three totes, drive to Auto Zone (TM)
@ -41,6 +43,7 @@ Autonomous::Autonomous(int seq){
} }
AddSequential(new Turn(90)); AddSequential(new Turn(90));
AddSequential(new AutoDrive(SmartDashboard::GetNumber("Auto Zone Distance"), -0.75)); AddSequential(new AutoDrive(SmartDashboard::GetNumber("Auto Zone Distance"), -0.75));
AddSequential(new ReleaseTote());
break; break;
default: default:
printf("Invalid seq: %d\n", seq); printf("Invalid seq: %d\n", seq);