change arm and hand angle input variables to constants
[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / commands / RetractDefenseArm.java
index 4dcd209e09f7f152359304413939f187f6948941..95f5f92e44ea2b7c4cfecb091e2c4907d44aa7d0 100755 (executable)
@@ -11,11 +11,14 @@ import edu.wpi.first.wpilibj.command.CommandGroup;
  *
  */
 public class RetractDefenseArm extends CommandGroup {
+  static final double ARM_FULLY_RETRACTED_ANGLE = 0; // change value once tested
+  static final double HAND_FULLY_RETRACTED_ANGLE = 0; // change value once
+                                                      // tested
 
-  public RetractDefenseArm(double speed, double retractPosition) {
+  public RetractDefenseArm(double speed) {
     requires(Robot.defenseArm);
 
-    addParallel(new SetArmToAngle(speed, retractPosition));
-    addParallel(new SetHandToAngle(speed, retractPosition));
+    addParallel(new SetArmToAngle(speed, ARM_FULLY_RETRACTED_ANGLE));
+    addParallel(new SetHandToAngle(speed, HAND_FULLY_RETRACTED_ANGLE));
   }
 }