Add calibration sleep

wheelerrobotics · Sep 28, 2024 · 7bc306e · 7bc306e
1 parent 7b9b799
commit 7bc306e
Showing 1 changed file with 6 additions and 0 deletions.
diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/PinpointDrive.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/PinpointDrive.java
@@ -85,6 +85,12 @@ public PinpointDrive(HardwareMap hardwareMap, Pose2d pose) {
          */
         //pinpoint.recalibrateIMU();
         pinpoint.resetPosAndIMU();
+        // wait for pinpoint to finish calibrating
+        try {
+            Thread.sleep(300);
+        } catch (InterruptedException e) {
+            throw new RuntimeException(e);
+        }
 
         pinpoint.setPosition(pose);
     }