2
0
mirror of https://github.com/team2059/Dent synced 2024-12-18 20:52:29 -05:00

Updated autonomous

This commit is contained in:
Austen Adler 2015-02-24 15:03:59 -05:00
parent e6e616b08d
commit 3ec24179bc

View File

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