From 9404d0bdc2bda13533d816c7b7e69cbb24986262 Mon Sep 17 00:00:00 2001 From: lukesta182 <33330639+lukesta182@users.noreply.github.com> Date: Tue, 6 Mar 2018 21:24:12 -0700 Subject: [PATCH] Scale On Right --- .../usfirst/frc4388/robot/commands/auton/ScaleFrom3.java | 8 +++++--- 1 file changed, 5 insertions(+), 3 deletions(-) diff --git a/src/org/usfirst/frc4388/robot/commands/auton/ScaleFrom3.java b/src/org/usfirst/frc4388/robot/commands/auton/ScaleFrom3.java index f1042f9..840080a 100644 --- a/src/org/usfirst/frc4388/robot/commands/auton/ScaleFrom3.java +++ b/src/org/usfirst/frc4388/robot/commands/auton/ScaleFrom3.java @@ -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