mirror of
https://github.com/team2059/Dent
synced 2024-12-18 20:52:29 -05:00
Updated autonomous
This commit is contained in:
parent
e6e616b08d
commit
3ec24179bc
@ -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);
|
||||
|
Loading…
Reference in New Issue
Block a user