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() {
}