Improve Climber Code

2026-06-09 08:48:01 -06:00 · 2020-03-06 16:42:53 -07:00
parent d480494910
commit 8113ce1a08
6 changed files with 88 additions and 6 deletions
@@ -40,12 +40,15 @@ public class RunClimberWithTriggers extends CommandBase {
    if (rightTrigger < .5) {
      if(rightTrigger > leftTrigger) {
        output = rightTrigger;
+        m_climber.shiftServo(false);
      }
      if (leftTrigger > rightTrigger) {
        output = -leftTrigger;
+        m_climber.shiftServo(true);
      }
    } else {
      output = rightTrigger;
+      m_climber.shiftServo(false);
    }
    m_climber.runClimber(output);
  }