change array name from levelsToDegrees to armPotValues
[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / subsystems / DefenseArm.java
index 776e8ac190f1f2168818639e8fc4c424a761ca74..bb2f6fb3eb6d3d02ef69631e1360e8c4d306aaf0 100755 (executable)
@@ -84,6 +84,33 @@ public class DefenseArm extends Subsystem {
     defenseHand.set(speed);
   }
 
+  public void moveArmDown(int levelsToDegrees) {
+    // to move arm down levels
+    if (levelsToDegrees > 0 & levelsToDegrees < 45) {
+      levelsToDegrees = 0;
+      if (levelsToDegrees > 45 & levelsToDegrees < 90) {
+        levelsToDegrees = 45;
+
+      }
+    }
+  }
+
+  public void moveArmTo(int levelsToDegrees) {
+
+  }
+
+  public void moveArmUp(int levelsToDegrees) {
+    // to move arm up levels
+    if (levelsToDegrees < 45 & levelsToDegrees > 0) {
+      levelsToDegrees = 45;
+      if (levelsToDegrees < 90 & levelsToDegrees > 45) {
+        levelsToDegrees = 90;
+
+      }
+
+    }
+  }
+
   @Override
   protected void initDefaultCommand() {
   }