Fix inverted bearing

This commit is contained in:
Scott Barnes 2024-03-08 10:14:58 -06:00
parent 070e9e6f9f
commit c61ada1b8f
1 changed files with 2 additions and 2 deletions

View File

@ -65,12 +65,12 @@ class AprilTagPoseEstimatorTest {
metadata,
new AprilTagPoseFtc(0, 0, 0, 0, 0, 0, 24, -45, 0),
new Pose2d(-7.77, 0.505, 0),
new Pose2d(35.5, 18.9, 0)),
new Pose2d(35.5, 52.9, 0)),
Arguments.of(
metadata,
new AprilTagPoseFtc(0, 0, 0, -45, 0, 0, 24, -45, 0),
new Pose2d(-7.77, 0.505, 0),
new Pose2d(31.1, 41.3, Math.PI / 4)),
new Pose2d(55.1, 65.3, Math.PI / 4)),
Arguments.of(
metadata,