private double targetSpeed;
private double calculatedSpeed;
private double SENSITIVITY_THRESHOLD = 0.1;
+ private double MIN_SPEED = .3;
public MoveIntakeArmToAngle(double angle, double speed) {
requires(Robot.intakeArm);
protected void initialize() {
// set the arm speed to the calculated angle
- Robot.intakeArm.setArmSpeed(getCalculatedSpeed());
+ double speed = getCalculatedSpeed();
+ if (speed < MIN_SPEED && speed > 0)
+ speed = Math.signum(getCalculatedSpeed()) * MIN_SPEED;
+ Robot.intakeArm.setArmSpeed(speed);
}
@Override