diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/pedroPathing/identification/StrafeVelocityIdentification.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/pedroPathing/identification/StrafeVelocityIdentification.java index a45b2b06bc27..a36970f436ea 100644 --- a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/pedroPathing/identification/StrafeVelocityIdentification.java +++ b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/pedroPathing/identification/StrafeVelocityIdentification.java @@ -82,7 +82,7 @@ public void loop() { follower.manual(0,1,0); double currentVelocity = Math.abs(follower.twist().toVector2D().y()); velocities.addLast(currentVelocity); - velocities.removeLast(); + velocities.removeFirst(); } } else { follower.manual(0,0,0); @@ -102,4 +102,4 @@ public void loop() { telemetry.update(); } } -} \ No newline at end of file +}