@Override
protected void initialize() {
- currentHeight = Robot.intakeArm.getArmAngle();
+ currentHeight = Robot.intakeArm.getArmHeight();
double difference = targetHeight - currentHeight;
if (difference > 0) {
Robot.intakeArm.setArmVoltage(targetSpeed);
@Override
protected boolean isFinished() {
- currentHeight = Robot.intakeArm.getArmAngle();
+ currentHeight = Robot.intakeArm.getArmHeight();
double distance = Math.abs(currentHeight - targetHeight);
if (distance <= SENSITIVITY_THRESHOLD) {
return true;