@@ -141,7 +141,7 @@ public final void presentTest1() throws Exception {
141141 var blueEstimate = locationalData .getBotPoseEstimateBlue ().get ();
142142 assertThat (blueEstimate .timestampSeconds ()).isGreaterThan (0.0 );
143143 var expectedPoseEstimate = new Pose2d (15.62 , 4.52 , rotation .toRotation2d ());
144- assertThat (blueEstimate .pose ()).isWithin (0.005 ).of (expectedPoseEstimate );
144+ assertThat (blueEstimate .pose ()).isWithin (0.01 ).of (expectedPoseEstimate );
145145
146146 assertThat (locationalData .getBotPoseEstimateRed ()).isPresent ();
147147 var redEstimate = locationalData .getBotPoseEstimateRed ().get ();
@@ -173,7 +173,7 @@ public final void presentTest2() throws Exception {
173173 Rotation3d rotation =
174174 new Rotation3d (Math .toRadians (-5.18 ), Math .toRadians (-24.32 ), Math .toRadians (-164.64 ));
175175 Pose3d expectedPose = new Pose3d (7.469 , 0.81 , 1.01 , rotation );
176- assertThat (actualPose ).isWithin (0.005 ).of (expectedPose );
176+ assertThat (actualPose ).isWithin (0.01 ).of (expectedPose );
177177
178178 assertThat (locationalData .getBotPoseEstimateBlue ()).isPresent ();
179179 var blueEstimate = locationalData .getBotPoseEstimateBlue ().get ();
@@ -201,7 +201,7 @@ public final void getBotposeBlue() throws Exception {
201201 Pose3d actualPose = botposeBlue .get ();
202202 Rotation3d expectedRotation = new Rotation3d (0 , 0 , Math .toRadians (-123.49 ));
203203 Pose3d expectedPose = new Pose3d (4.72 , 5.20 , 0 , expectedRotation );
204- assertThat (actualPose ).isWithin (0.005 ).of (expectedPose );
204+ assertThat (actualPose ).isWithin (0.01 ).of (expectedPose );
205205 }
206206
207207 @ Test
@@ -218,7 +218,7 @@ public final void getBotposeRed() throws Exception {
218218
219219 Rotation3d expectedRotation = new Rotation3d (0 , 0 , Math .toRadians (56.51 ));
220220 Pose3d expectedPose = new Pose3d (11.83 , 3.01 , 0 , expectedRotation );
221- assertThat (actualPose ).isWithin (0.005 ).of (expectedPose );
221+ assertThat (actualPose ).isWithin (0.01 ).of (expectedPose );
222222 }
223223
224224 @ Test
0 commit comments