X-Git-Url: http://challenge-bot.com/repos/?a=blobdiff_plain;f=src%2Forg%2Fusfirst%2Ffrc%2Fteam3501%2Frobot%2Fcommands%2Fintakearm%2FMoveIntakeArmToAngle.java;h=510146cc1a8bc7a425c29dda2d63ab7dbe7a5e32;hb=5cff891038f613483040c7f1a2b5b554adcd3313;hp=f00e62e1984bb4dc49b682bc2b911c118f8c27b2;hpb=822569e25e03cd0c89c2365787bfeb05a77dfb0d;p=3501%2Fstronghold-2016

diff --git a/src/org/usfirst/frc/team3501/robot/commands/intakearm/MoveIntakeArmToAngle.java b/src/org/usfirst/frc/team3501/robot/commands/intakearm/MoveIntakeArmToAngle.java
index f00e62e1..510146cc 100644
--- a/src/org/usfirst/frc/team3501/robot/commands/intakearm/MoveIntakeArmToAngle.java
+++ b/src/org/usfirst/frc/team3501/robot/commands/intakearm/MoveIntakeArmToAngle.java
@@ -10,6 +10,7 @@ public class MoveIntakeArmToAngle extends Command {
   private double targetSpeed;
   private double calculatedSpeed;
   private double SENSITIVITY_THRESHOLD = 0.1;
+  private double MIN_SPEED = .3;
 
   public MoveIntakeArmToAngle(double angle, double speed) {
     requires(Robot.intakeArm);
@@ -22,8 +23,11 @@ public class MoveIntakeArmToAngle extends Command {
   protected void initialize() {
 
     // set the arm speed to the calculated angle
-    Robot.intakeArm.setArmSpeed(getCalculatedSpeed());
+    double speed = getCalculatedSpeed();
 
+    if (speed < MIN_SPEED && speed > 0)
+      speed = Math.signum(getCalculatedSpeed()) * MIN_SPEED;
+    Robot.intakeArm.setArmSpeed(speed);
   }
 
   @Override