From 9faf4bc004fbfffaab4366de63221f12b80afc4a Mon Sep 17 00:00:00 2001
From: j5155 <54331556+j5155@users.noreply.github.com>
Date: Fri, 20 Sep 2024 15:39:22 -0800
Subject: [PATCH] update road-runner-ftc fork

---
 TeamCode/build.gradle                                      | 2 +-
 .../java/org/firstinspires/ftc/teamcode/PinpointDrive.java | 7 +------
 2 files changed, 2 insertions(+), 7 deletions(-)

diff --git a/TeamCode/build.gradle b/TeamCode/build.gradle
index 479308666e8c..4d9937226f5c 100644
--- a/TeamCode/build.gradle
+++ b/TeamCode/build.gradle
@@ -38,5 +38,5 @@ dependencies {
     implementation "com.acmerobotics.roadrunner:core:1.0.0"
     implementation "com.acmerobotics.roadrunner:actions:1.0.0"
     implementation "com.acmerobotics.dashboard:dashboard:0.4.16"
-    implementation "com.github.jdhs-ftc:road-runner-ftc-otos:14c7f4ca9a"
+    implementation "com.github.jdhs-ftc:road-runner-ftc-otos:622d5b95a5"
 }
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 7ad0fd2e1a8c..75471c09dd94 100644
--- a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/PinpointDrive.java
+++ b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/PinpointDrive.java
@@ -110,12 +110,7 @@ public PoseVelocity2d updatePoseEstimate() {
 
         FlightRecorder.write("ESTIMATED_POSE", new PoseMessage(pose));
 
-        Pose2d velocity = pinpoint.getVelocity();
-        // RR localizer note
-        // "velocity.position" is a little weird
-        // it's because velocity is stored as a roadrunner pose2d right now
-        // maybe not ideal for this, probably I should change it to use a PoseVelocity2d directly instead
-        return new PoseVelocity2d(new Vector2d(velocity.position.x, velocity.position.y),velocity.heading.toDouble());
+        return pinpoint.getVelocity();
     }