- addSequential(new DriveDistance());
- // Robot turns left towards hopper
- addSequential(new TurnForAngle(90));
- // Robot drives in front of hopper
- addSequential(new DriveDistance());
- // Robot turns to face hopper
- addSequential(new TurnForAngle(90));
- // Robot hits hopper switch
- addSequential(new DriveDistance());
+ addSequential(new DriveDistance(DISTANCE_TO_HOPPER, 1));
+ // Robot turns right towards hopper
+ addSequential(new TurnForAngle(45.0, Constants.Direction.RIGHT, 1.0));
+ // Robot drives into hopper switch
+ addSequential(new DriveDistance(2.0, 1.0));