public static final int ARM_LEFT = 2, ARM_RIGHT = 7;
public static final double ARM_HIGH_SPEED = 0.5, ARM_LOW_SPEED = 0.5;
- public static final int ARM_LIMIT_RIGHT = 0;
+ public static final int ARM_LIMIT_1 = 0, ARM_LIMIT_2 = 1, ARM_LIMIT_3 = 2, ARM_LIMIT_4 = 3;
// Claw
public static final int SOLENOID_FORWARD = 0, SOLENOID_REVERSE = 1,
public class Arm extends Subsystem {
private CANJaguar left, right;
- private DigitalInput limitSwitch;
+ private DigitalInput limit1, limit2, limit3, limit4;
public Arm() {
left = new CANJaguar(RobotMap.ARM_LEFT);
right = new CANJaguar(RobotMap.ARM_RIGHT);
- limitSwitch = new DigitalInput(RobotMap.ARM_LIMIT_RIGHT);
+ limit1 = new DigitalInput(RobotMap.ARM_LIMIT_1);
+ limit2 = new DigitalInput(RobotMap.ARM_LIMIT_2);
+ limit3 = new DigitalInput(RobotMap.ARM_LIMIT_3);
+ limit4 = new DigitalInput(RobotMap.ARM_LIMIT_4);
}
public void initDefaultCommand() {