- public final static int ENCODER_LEFT_A = 3;
- public final static int ENCODER_LEFT_B = 4;
- public final static int ENCODER_RIGHT_A = 2;
- public final static int ENCODER_RIGHT_B = 1;
+ public final static int ENCODER_LEFT_A = 0;
+ public final static int ENCODER_LEFT_B = 1;
+ public final static int ENCODER_RIGHT_A = 9;
+ public final static int ENCODER_RIGHT_B = 8;
+
+ public final static int FORWARD_CHANNEL = 0;
+ public final static int REVERSE_CHANNEL = 0;
+
+ private final static double WHEEL_DIAMETER = 6.0; // in inches
+ private final static double PULSES_PER_ROTATION = 256; // in pulses
+ private final static double OUTPUT_SPROCKET_DIAMETER = 2.0; // in inches
+ private final static double WHEEL_SPROCKET_DIAMETER = 3.5; // in inches
+ public static final double INCHES_PER_PULSE =
+ ((3.66 / 5.14) * 6 * Math.PI) / 256;
+
+ public static final int MANUAL_MODE = 1, ENCODER_MODE = 2, GYRO_MODE = 3;
+ public static final int LEFT_FORWARD = 0, LEFT_REVERSE = 1,
+ RIGHT_FORWARD = 2, RIGHT_REVERSE = 3;
+ public static double time = 0;
+
+ // Gearing constants
+ public static final Value HIGH_GEAR = DoubleSolenoid.Value.kForward;
+ public static final Value LOW_GEAR = DoubleSolenoid.Value.kReverse;
+