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 class CenterLeft extends CommandGroup {
|
||||||
|
|
||||||
public CenterLeft() {
|
public CenterLeft()
|
||||||
|
{
|
||||||
addSequential(new DriveGyroReset());
|
addSequential(new DriveGyroReset());
|
||||||
|
|
||||||
addSequential(new IntakePosition(true));
|
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 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 DriveTurnBasic(true, 28, 300, MPSoftwareTurnType.TANK));
|
||||||
addSequential(new ElevatorBasic(20));
|
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 IntakeSetSpeed(Carriage.CUBE_EJECT_SPEED));
|
||||||
//addSequential(new WaitCommand(.1));
|
//addSequential(new WaitCommand(.1));
|
||||||
addSequential(new IntakePosition(false));
|
addSequential(new IntakePosition(false));
|
||||||
addSequential(new WaitCommand(.5));
|
addSequential(new WaitCommand(.2));
|
||||||
addSequential(new IntakeSetSpeed(Carriage.CUBE_STOP_SPEED));
|
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 class CenterRight extends CommandGroup
|
||||||
|
{
|
||||||
public CenterRight()
|
public CenterRight()
|
||||||
{
|
{
|
||||||
addSequential(new DriveGyroReset());
|
addSequential(new DriveGyroReset());
|
||||||
|
|
||||||
addSequential(new IntakePosition(true));
|
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 DriveTurnBasic(true, -130, 300, MPSoftwareTurnType.TANK));
|
||||||
addSequential(new DriveStraightBasic(50, 60, true, true, 0));
|
addSequential(new DriveStraightBasic(53, 60, true, true, 0));
|
||||||
addSequential(new DriveTurnBasic(true, 28, 300, MPSoftwareTurnType.TANK));
|
|
||||||
addSequential(new ElevatorBasic(20));
|
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 IntakeSetSpeed(Carriage.CUBE_EJECT_SPEED));
|
||||||
//addSequential(new WaitCommand(.1));
|
//addSequential(new WaitCommand(.1));
|
||||||
addSequential(new IntakePosition(false));
|
addSequential(new IntakePosition(false));
|
||||||
addSequential(new WaitCommand(.5));
|
addSequential(new WaitCommand(.2));
|
||||||
addSequential(new IntakeSetSpeed(Carriage.CUBE_STOP_SPEED));
|
addSequential(new IntakeSetSpeed(Carriage.CUBE_STOP_SPEED));
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user