private final double DEFAULT_SPEED = 0.5;
+ // in inches
+ // assuming that positive angle means turning right
+ // and negative angle means turning left
+
// constants for position 1: low bar
- private final double POS1_DIST1 = 0;
- private final double POS1_TURN1 = 0;
+ private final double POS1_DIST1 = 109;
+ private final double POS1_TURN1 = 60;
private final double POS1_DIST2 = 0;
// constants for position 2
- private final double POS2_DIST1 = 0;
- private final double POS2_TURN1 = 0;
+ private final double POS2_DIST1 = 140;
+ private final double POS2_TURN1 = 60;
private final double POS2_DIST2 = 0;
// constants for position 3
private final double POS3_DIST1 = 0;
- private final double POS3_TURN1 = 0;
- private final double POS3_DIST2 = 0;
- private final double POS3_TURN2 = 0;
+ private final double POS3_TURN1 = 90;
+ private final double POS3_DIST2 = 35.5;
+ private final double POS3_TURN2 = -90;
private final double POS3_DIST3 = 0;
// constants for position 4
private final double POS4_DIST1 = 0;
- private final double POS4_TURN1 = 0;
- private final double POS4_DIST2 = 0;
- private final double POS4_TURN2 = 0;
+ private final double POS4_TURN1 = -90;
+ private final double POS4_DIST2 = 18.5;
+ private final double POS4_TURN2 = 90;
private final double POS4_DIST3 = 0;
// constants for position 5