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

Added an auto sequence to collect a tote from the landfill zone

Browse Source
This commit is contained in:
Adam Long 2015-04-23 09:09:43 +00:00 committed by Austen Adler
parent ff39bf9409
commit abff070940
1 changed files with 7 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
Commands/Autonomous/Autonomous.cpp
View File

@ -65,6 +65,13 @@ Autonomous::Autonomous(int seq){
AddSequential(new AutoDrive(SmartDashboard::GetNumber("Auto Zone Distance"), 0.0, 0.75));
AddSequential(new Turn(2.1));
break;
case 6:
//Drive forward and collect a single gray tote
AddSequential(new Lower(3.0));
AddSequential(new CollectTote(SmartDashboard::GetNumber("CollectToteTurn")));
AddSequential(new Lower(3.0));
AddSequential(new Raise(3.5));
AddSequential(new AutoDrive(SmartDashboard::GetNumber("Auto Zone Distance"), 0.0, -0.75));
default:
printf("Invalid seq: %d\n", seq);
break;