Scale On Right

This commit is contained in:
lukesta182
2018-03-06 21:24:12 -07:00
parent 47b48b2e42
commit 9404d0bdc2
@@ -26,16 +26,18 @@ public class ScaleFrom3 extends CommandGroup {
addSequential(new DriveGyroReset());
addSequential(new DriveSpeedShift(true));
addSequential(new IntakePosition(true));
addSequential(new DriveStraightBasic(-200, 60, true, true, 0));
addSequential(new ElevatorBasic(10));
addSequential(new DriveTurnBasic(true, 150, 300, MPSoftwareTurnType.TANK));
addSequential(new DriveStraightBasic(-290, 60, true, true, 0));
addSequential(new ElevatorBasic(70));
addSequential(new DriveStraightBasic(10, 20, true, true, 0));
addSequential(new DriveTurnBasic(true, 90, 100, MPSoftwareTurnType.TANK));
//addSequential(new DriveStraightBasic(5, 20, true, true, 0));
addSequential(new IntakeSetSpeed(Carriage.CUBE_EJECT_SPEED));
//addSequential(new WaitCommand(.1));
addSequential(new IntakePosition(false));
addSequential(new WaitCommand(.5));
addSequential(new IntakeSetSpeed(Carriage.CUBE_STOP_SPEED));
addSequential(new DriveStraightBasic(-15, 20, true, true, 0));
addSequential(new ElevatorBasic(5));
//addSequential(new DriveStraightMP(60, 10, true, true, 0)); // 95 for 112" greenville