Make Vision Work

2026-06-09 00:38:02 -06:00 · 2025-01-11 15:35:24 -07:00
parent 84faad46c4
commit 7fdb5dcd58
4 changed files with 54 additions and 13 deletions
@@ -108,16 +108,13 @@ public class Vision extends Subsystem {
        lastVisionPose = EstimatedRobotPose.get().estimatedPose.toPose2d();
        // lastVisionPose.rotateBy(lastVisionPose.getRotation().minus(lastPhysOdomPose.getRotation()));
        // lastVisionPose = new Pose2d(
-        //     lastVisionPose.getTranslation(), 
+        //     lastVisionPose.getTranslation(),
        //     lastPhysOdomPose.getRotation()
        // );

        
        
        field.setRobotPose(getPose2d());
-
-
-
    }