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