- addSequential(new TurnForAngle(90.0, Constants.Direction.RIGHT, 1.0));
- // Robot drives near hopper
- addSequential(new DriveDistance(191.5, 1));
- // Robot turns left towards hopper
- addSequential(new TurnForAngle(90.0, Constants.Direction.LEFT, 1.0));
- // Robot drives in front of hopper
- addSequential(new DriveDistance(30.0, 1.0));
- // Robot turns to face hopper
- addSequential(new TurnForAngle(90.0, Constants.Direction.RIGHT, 1.0));
- // Robot hits hopper switch
- addSequential(new DriveDistance(2.0, 1.0));
+ addSequential(new TurnForAngle(90.0, DIRECTION_TO_HOPPER, 1.0));
+ // Robot drives into hopper switch
+ addSequential(new DriveDistance(44.0, 1));