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

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

This commit is contained in:
Adam Long 2015-04-23 09:09:43 +00:00 committed by Austen Adler
parent ff39bf9409
commit abff070940

View File

@ -65,6 +65,13 @@ Autonomous::Autonomous(int seq){
AddSequential(new AutoDrive(SmartDashboard::GetNumber("Auto Zone Distance"), 0.0, 0.75)); AddSequential(new AutoDrive(SmartDashboard::GetNumber("Auto Zone Distance"), 0.0, 0.75));
AddSequential(new Turn(2.1)); AddSequential(new Turn(2.1));
break; 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: default:
printf("Invalid seq: %d\n", seq); printf("Invalid seq: %d\n", seq);
break; break;