From 7bc306e2b361900d6feb205c89f7ce84fc0fa96d Mon Sep 17 00:00:00 2001
From: j5155 <54331556+j5155@users.noreply.github.com>
Date: Sat, 28 Sep 2024 15:18:52 -0800
Subject: [PATCH] Add calibration sleep

---
 .../java/org/firstinspires/ftc/teamcode/PinpointDrive.java  | 6 ++++++
 1 file changed, 6 insertions(+)

diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/PinpointDrive.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/PinpointDrive.java
index 7e05e2f33abd..7280f9e4b18b 100644
--- 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);
     }