diff --git a/Commands/Autonomous/Autonomous.cpp b/Commands/Autonomous/Autonomous.cpp index 7c67c32..ae36302 100644 --- a/Commands/Autonomous/Autonomous.cpp +++ b/Commands/Autonomous/Autonomous.cpp @@ -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;