}
public static class DriveTrain {
- // Drivetrain Motor Related Ports
+ public static final int TANK_DRIVE = 0;
+ public static final int ARCADE_DRIVE = 1;
+ public static final int DRIVE_TYPE = TANK_DRIVE;
+
+ // Drivetrain Motor related ports
public static final int DRIVE_FRONT_LEFT = 1;
public static final int DRIVE_REAR_LEFT = 2;
public static final int DRIVE_FRONT_RIGHT = 6;
public static final int DRIVE_REAR_RIGHT = 5;
- // Encoder related ports
- public final static int ENCODER_LEFT_A = 0;
- public final static int ENCODER_LEFT_B = 1;
- public final static int ENCODER_RIGHT_A = 3;
- public final static int ENCODER_RIGHT_B = 4;
-
+ // Drivetrain shifter related ports
public static final int LEFT_SHIFT_MODULE = PCM_MODULE_B;
public static final int LEFT_SHIFT_FORWARD = 3;
public static final int LEFT_SHIFT_REVERSE = 6;
public static final int RIGHT_SHIFT_FORWARD = 2;
public static final int RIGHT_SHIFT_REVERSE = 7;
+ // Encoder related ports
+ public final static int ENCODER_LEFT_A = 0;
+ public final static int ENCODER_LEFT_B = 1;
+ public final static int ENCODER_RIGHT_A = 3;
+ public final static int ENCODER_RIGHT_B = 4;
+
public static final double INCHES_PER_PULSE = ((3.66 / 5.14) * 6 * Math.PI) / 256;
public static double kp = 0.013, ki = 0.000015, kd = -0.002;