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:
parent
ff39bf9409
commit
abff070940
@ -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;
|
||||||
|
Loading…
Reference in New Issue
Block a user