mirror of
https://github.com/Team4388/2018-Robot.git
synced 2026-06-09 00:38:04 -06:00
Autonomous Update
Center Right and Left Tuned for 3/5/18
This commit is contained in:
@@ -22,23 +22,21 @@ import edu.wpi.first.wpilibj.command.WaitCommand;
|
||||
*/
|
||||
public class CenterLeft extends CommandGroup {
|
||||
|
||||
public CenterLeft() {
|
||||
public CenterLeft()
|
||||
{
|
||||
addSequential(new DriveGyroReset());
|
||||
|
||||
addSequential(new IntakePosition(true));
|
||||
addSequential(new DriveStraightBasic(-10, 60, true, true, 0));
|
||||
addSequential(new DriveStraightBasic(-15, 60, true, true, 0));
|
||||
addSequential(new DriveTurnBasic(true, 130, 300, MPSoftwareTurnType.TANK));
|
||||
addSequential(new DriveStraightBasic(50, 60, true, true, 0));
|
||||
addSequential(new DriveStraightBasic(65, 60, true, true, 0));
|
||||
addSequential(new DriveTurnBasic(true, 28, 300, MPSoftwareTurnType.TANK));
|
||||
addSequential(new ElevatorBasic(20));
|
||||
addSequential(new DriveStraightBasic(25, 60, true, true, 0));
|
||||
addSequential(new DriveStraightBasic(30, 60, true, true, 0));
|
||||
addSequential(new IntakeSetSpeed(Carriage.CUBE_EJECT_SPEED));
|
||||
//addSequential(new WaitCommand(.1));
|
||||
addSequential(new IntakePosition(false));
|
||||
addSequential(new WaitCommand(.5));
|
||||
addSequential(new WaitCommand(.2));
|
||||
addSequential(new IntakeSetSpeed(Carriage.CUBE_STOP_SPEED));
|
||||
|
||||
//addSequential(new DriveStraightMP(60, 10, true, true, 0)); // 95 for 112" greenville
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
@@ -20,23 +20,23 @@ import edu.wpi.first.wpilibj.command.WaitCommand;
|
||||
/**
|
||||
*
|
||||
*/
|
||||
public class CenterRight extends CommandGroup {
|
||||
|
||||
public CenterRight()
|
||||
public class CenterRight extends CommandGroup
|
||||
{
|
||||
public CenterRight()
|
||||
{
|
||||
addSequential(new DriveGyroReset());
|
||||
|
||||
addSequential(new IntakePosition(true));
|
||||
addSequential(new DriveStraightBasic(-10, 60, true, true, 0));
|
||||
addSequential(new DriveTurnBasic(true, 130, 300, MPSoftwareTurnType.TANK));
|
||||
addSequential(new DriveStraightBasic(50, 60, true, true, 0));
|
||||
addSequential(new DriveTurnBasic(true, 28, 300, MPSoftwareTurnType.TANK));
|
||||
addSequential(new DriveStraightBasic(-15, 60, true, true, 0));
|
||||
addSequential(new DriveTurnBasic(true, -130, 300, MPSoftwareTurnType.TANK));
|
||||
addSequential(new DriveStraightBasic(53, 60, true, true, 0));
|
||||
addSequential(new ElevatorBasic(20));
|
||||
addSequential(new DriveStraightBasic(25, 60, true, true, 0));
|
||||
addSequential(new DriveTurnBasic(true, -34.5, 300, MPSoftwareTurnType.TANK));
|
||||
addSequential(new DriveStraightBasic(19, 60, true, true, 0));
|
||||
addSequential(new IntakeSetSpeed(Carriage.CUBE_EJECT_SPEED));
|
||||
//addSequential(new WaitCommand(.1));
|
||||
addSequential(new IntakePosition(false));
|
||||
addSequential(new WaitCommand(.5));
|
||||
addSequential(new WaitCommand(.2));
|
||||
addSequential(new IntakeSetSpeed(Carriage.CUBE_STOP_SPEED));
|
||||
}
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user