elbow and wrist adjust

svhsrobotics · Feb 29, 2024 · a6a6192 · a6a6192
1 parent 7439a59
commit a6a6192
Showing 1 changed file with 4 additions and 4 deletions.
diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/opmode/TestTeleOp.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/opmode/TestTeleOp.java
@@ -36,7 +36,7 @@ public void runOpMode() throws InterruptedException {
 
         double purplePose = 0.5;
         int armPos = 0;
-        double wristPos = 0;
+        double wristPos = 1.0;
         Toggle pinchToggle = new Toggle();
         ArmState currentState = ArmState.MANUAL;
         int offset = 0;
@@ -136,9 +136,9 @@ public void runOpMode() throws InterruptedException {
                 } else if (gamepad1.dpad_right || gamepad2.dpad_right) {
                     elbowPos += 0.008; // DOWN
                 }
-                if (elbowPos > 0.55) wristPos = 0.55;
-                if (wristPos < 0.2) wristPos = 0.2;
-                rrobot.elbowServo.setPosition(wristPos);
+                if (elbowPos > 0.55) elbowPos = 0.55;
+                if (elbowPos < 0.2) elbowPos = 0.2;
+                rrobot.elbowServo.setPosition(elbowPos);
 
                 if (gamepad1.dpad_up || gamepad2.dpad_up) {
                     pinchLocation = pinchLocation + 0.008;