X-Git-Url: http://challenge-bot.com/repos/?a=blobdiff_plain;ds=sidebyside;f=src%2Forg%2Fusfirst%2Ffrc%2Fteam3501%2Frobot%2Fcommandgroups%2FAutonHopperShoot.java;fp=src%2Forg%2Fusfirst%2Ffrc%2Fteam3501%2Frobot%2Fcommandgroups%2FAutonHopperShoot.java;h=2083548128fed923cdb270307c12d71c53bc8ff3;hb=f2fe3ff51d50129d53fe6589945486730d4349bd;hp=94dfb9eb2a3d49afa0c6c4ec22236a5365fd2d0f;hpb=82696d5cb6a37720151c2c58f933d78dad46e9b6;p=3501%2F2017steamworks diff --git a/src/org/usfirst/frc/team3501/robot/commandgroups/AutonHopperShoot.java b/src/org/usfirst/frc/team3501/robot/commandgroups/AutonHopperShoot.java index 94dfb9e..2083548 100644 --- a/src/org/usfirst/frc/team3501/robot/commandgroups/AutonHopperShoot.java +++ b/src/org/usfirst/frc/team3501/robot/commandgroups/AutonHopperShoot.java @@ -8,18 +8,20 @@ import org.usfirst.frc.team3501.robot.commands.shooter.RunFlyWheelContinuous; import edu.wpi.first.wpilibj.command.CommandGroup; /** - * + * // Robot starts in middle, goes to the hopper, then boiler,then shoots during + * auton */ public class AutonHopperShoot extends CommandGroup { - public AutonHopperShoot() { + private static final double DISTANCE_TO_HOPPER = 224.569677; + public AutonHopperShoot() { // Robot drives from center to front of airship addSequential(new DriveDistance(5.0, 1)); // Robot turns towards hopper addSequential(new TurnForAngle(45.0, Constants.Direction.RIGHT, 1.0)); // Robot drives near hopper - addSequential(new DriveDistance(224.569677, 1)); + addSequential(new DriveDistance(DISTANCE_TO_HOPPER, 1)); // Robot turns left towards hopper addSequential(new TurnForAngle(45.0, Constants.Direction.RIGHT, 1.0)); // Robot drives in front of hopper