private double currentPosition;
private boolean isDecreasing = false;
- public SetHandToLevel(double speed, double targetPosition) {
+ public SetHandToLevel(double speed, int level) {
requires(Robot.defenseArm);
this.speed = speed;
- this.targetPosition = targetPosition;
+ this.targetPosition = Robot.defenseArm.getAngleForLocation(level);
}
@Override