@@ -0,0 +1,1624 @@
+package com.team687.frc2017.commands.auto;%0A%0Aimport com.team687.frc2017.Constants;%0Aimport com.team687.frc2017.commands.DriveBezierRio;%0Aimport com.team687.frc2017.commands.DriveDistancePID;%0Aimport com.team687.frc2017.commands.DriveTime;%0Aimport com.team687.frc2017.commands.TurnToAngle;%0Aimport com.team687.frc2017.commands.WaitTime;%0A%0Aimport edu.wpi.first.wpilibj.command.CommandGroup;%0A%0A/**%0A * Blue peg close to hopper two gear auto (similar to 1011 FOC auto)%0A * %0A * @author tedlin%0A * %0A */%0A%0Apublic class BlueClosePegTwoGearAuto extends CommandGroup %7B%0A%0A    public BlueClosePegTwoGearAuto() %7B%0A%09addSequential(new DriveBezierRio(Constants.BluePathWallToClosePeg, -0.687, true, true));%0A%09// addSequential(new DeployGear());%0A%09addSequential(new DriveBezierRio(Constants.BluePathClosePegBackUp, 0.687, true, true));%0A%09addSequential(new WaitTime(0.2));%0A%0A%09addSequential(new TurnToAngle(Constants.BlueWallCloseToSecondGearAngle, 4, true));%0A%09addSequential(new WaitTime(0.2));%0A%09// addParallel(new IntakeGear());%0A%09addSequential(new DriveDistancePID(Constants.BlueWallCloseToSecondGearDistance,%0A%09%09Constants.BlueWallCloseToSecondGearDistance));%0A%09addSequential(new WaitTime(0.2));%0A%09addSequential(new DriveDistancePID(-Constants.BlueWallCloseToSecondGearDistance,%0A%09%09-Constants.BlueWallCloseToSecondGearDistance));%0A%09addSequential(new WaitTime(0.2));%0A%09// addParallel(new GearManipUp());%0A%09addSequential(new TurnToAngle(0, 4, true));%0A%09addSequential(new WaitTime(0.2));%0A%0A%09addSequential(new DriveBezierRio(Constants.BluePathWallToClosePeg, -0.687, true, true));%0A%09// addSequential(new DeployGear());%0A%09addSequential(new DriveTime(0.5, 3, false));%0A    %7D%0A%0A%7D%0A

add 1011 type auto