public static final double kADJUST = 8;
// Drivetrain Motor related ports
- public static final int DRIVE_FRONT_LEFT = 6;
- public static final int DRIVE_REAR_LEFT = 5;
- public static final int DRIVE_FRONT_RIGHT = 1;
- public static final int DRIVE_REAR_RIGHT = 2;
+ 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;
// Drivetrain shifter related ports
public static final int LEFT_SHIFT_MODULE = PCM_MODULE_B;
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 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;
public static double encoderTolerance = 8.0;
public static final Value SHOOT = Value.kForward;
public static final Value RESET = Value.kReverse;
public static final double WAIT_TIME = 2.0; // In seconds
+
+ // TODO: test for this time
+ public static final double TIME_FOR_BALL_TO_CATAPULT_ROLLING = 1.0;
+
}
public static class IntakeArm {