import org.usfirst.frc.team3501.robot.Constants;
import org.usfirst.frc.team3501.robot.commands.driving.DriveDistance;
import org.usfirst.frc.team3501.robot.commands.driving.TurnForAngle;
-import org.usfirst.frc.team3501.robot.commands.shooter.RunFlyWheel;
+import org.usfirst.frc.team3501.robot.commands.shooter.RunFlyWheelContinuous;
import edu.wpi.first.wpilibj.command.CommandGroup;
// Robot turns towards hopper
addSequential(new TurnForAngle(90.0, Constants.Direction.RIGHT, 1.0));
// Robot drives near hopper
- addSequential(new DriveDistance());
+ addSequential(new DriveDistance(191.5, 1));
// Robot turns left towards hopper
- addSequential(new TurnForAngle(90));
+ addSequential(new TurnForAngle(90.0, Constants.Direction.LEFT, 1.0));
// Robot drives in front of hopper
- addSequential(new DriveDistance());
+ addSequential(new DriveDistance(30.0, 1.0));
// Robot turns to face hopper
- addSequential(new TurnForAngle(90));
+ addSequential(new TurnForAngle(90.0, Constants.Direction.RIGHT, 1.0));
// Robot hits hopper switch
- addSequential(new DriveDistance());
+ addSequential(new DriveDistance(2.0, 1.0));
// Robot backs up from switch
- addSequential(new DriveDistance());
+ addSequential(new DriveDistance(2.0, -1.0));
// Robot turns towards the boiler
- addSequential(new TurnForAngle(90));
+ addSequential(new TurnForAngle(90.0, Constants.Direction.RIGHT, 1.0));
// Robot drives to boiler
- addSequential(new DriveDistance());
+ addSequential(new DriveDistance(123.3, 1.0));
// Robot turns parallel to boiler
- addSequential(new TurnForAngle(45));
+ addSequential(new TurnForAngle(45.0, Constants.Direction.LEFT, 1.0));
// Shoot
- addSequential(new RunFlyWheel());
+ addSequential(new RunFlyWheelContinuous(1.0));
}
}