X-Git-Url: http://challenge-bot.com/repos/?a=blobdiff_plain;f=src%2Forg%2Fusfirst%2Ffrc%2Fteam3501%2Frobot%2Fsubsystems%2FDefenseArm.java;h=bb2f6fb3eb6d3d02ef69631e1360e8c4d306aaf0;hb=3c61311bb584cde33a56b286e84cc376dd866acf;hp=776e8ac190f1f2168818639e8fc4c424a761ca74;hpb=962638a957736f500cedc66b8dfc84dc81ac7f80;p=3501%2Fstronghold-2016 diff --git a/src/org/usfirst/frc/team3501/robot/subsystems/DefenseArm.java b/src/org/usfirst/frc/team3501/robot/subsystems/DefenseArm.java index 776e8ac1..bb2f6fb3 100755 --- a/src/org/usfirst/frc/team3501/robot/subsystems/DefenseArm.java +++ b/src/org/usfirst/frc/team3501/robot/subsystems/DefenseArm.java @@ -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() { }