Fix formatting

Author: bhall-ctre

wpimath/src/test/java/edu/wpi/first/math/estimator/SwerveDrivePoseEstimator3dTest.java

@@ -511,8 +511,8 @@ void testReset() {
         () -> assertEquals(0, estimator.getEstimatedPosition().getRotation().getZ(), kEpsilon));
 
     // Add a vision measurement with a different translation
-    estimator.addVisionMeasurement(new Pose3d(3, 0, 0, Rotation3d.kZero),
-        MathSharedStore.getTimestamp());
+    estimator.addVisionMeasurement(
+        new Pose3d(3, 0, 0, Rotation3d.kZero), MathSharedStore.getTimestamp());
 
     assertAll(
         () -> assertEquals(2.5, estimator.getEstimatedPosition().getX(), kEpsilon),
@@ -556,8 +556,8 @@ void testReset() {
                 Math.PI / 2, estimator.getEstimatedPosition().getRotation().getZ(), kEpsilon));
 
     // Add a vision measurement with a different rotation
-    estimator.addVisionMeasurement(new Pose3d(2.5, 1, 0, new Rotation3d(Rotation2d.k180deg)),
-        MathSharedStore.getTimestamp());
+    estimator.addVisionMeasurement(
+        new Pose3d(2.5, 1, 0, new Rotation3d(Rotation2d.k180deg)), MathSharedStore.getTimestamp());
 
     assertAll(
         () -> assertEquals(2.5, estimator.getEstimatedPosition().getX(), kEpsilon),
@@ -567,7 +567,9 @@ void testReset() {
         () -> assertEquals(0, estimator.getEstimatedPosition().getRotation().getY(), kEpsilon),
         () ->
             assertEquals(
-                Math.PI * 3.0 / 4, estimator.getEstimatedPosition().getRotation().getZ(), kEpsilon));
+                Math.PI * 3.0 / 4,
+                estimator.getEstimatedPosition().getRotation().getZ(),
+                kEpsilon));
 
     // Test reset translation
     estimator.resetTranslation(new Translation3d(-1, -1, -1));
@@ -580,7 +582,9 @@ void testReset() {
         () -> assertEquals(0, estimator.getEstimatedPosition().getRotation().getY(), kEpsilon),
         () ->
             assertEquals(
-                Math.PI * 3.0 / 4, estimator.getEstimatedPosition().getRotation().getZ(), kEpsilon));
+                Math.PI * 3.0 / 4,
+                estimator.getEstimatedPosition().getRotation().getZ(),
+                kEpsilon));
 
     // Test reset pose
     estimator.resetPose(Pose3d.kZero);

wpimath/src/test/java/edu/wpi/first/math/estimator/SwerveDrivePoseEstimatorTest.java

@@ -483,7 +483,8 @@ void testReset() {
             assertEquals(0, estimator.getEstimatedPosition().getRotation().getRadians(), kEpsilon));
 
     // Add a vision measurement with a different translation
-    estimator.addVisionMeasurement(new Pose2d(3, 0, Rotation2d.kZero), MathSharedStore.getTimestamp());
+    estimator.addVisionMeasurement(
+        new Pose2d(3, 0, Rotation2d.kZero), MathSharedStore.getTimestamp());
 
     assertAll(
         () -> assertEquals(2.5, estimator.getEstimatedPosition().getX(), kEpsilon),
@@ -523,7 +524,8 @@ void testReset() {
                 kEpsilon));
 
     // Add a vision measurement with a different rotation
-    estimator.addVisionMeasurement(new Pose2d(2.5, 1, Rotation2d.kPi), MathSharedStore.getTimestamp());
+    estimator.addVisionMeasurement(
+        new Pose2d(2.5, 1, Rotation2d.kPi), MathSharedStore.getTimestamp());
 
     assertAll(
         () -> assertEquals(2.5, estimator.getEstimatedPosition().getX(), kEpsilon),

wpimath/src/test/native/cpp/estimator/SwerveDrivePoseEstimator3dTest.cpp

@@ -455,7 +455,7 @@ TEST(SwerveDrivePoseEstimator3dTest, TestReset) {
 
   // Add a vision measurement with a different translation
   estimator.AddVisionMeasurement(frc::Pose3d(3_m, 0_m, 0_m, frc::Rotation3d{}),
-      wpi::math::MathSharedStore::GetTimestamp());
+                                 wpi::math::MathSharedStore::GetTimestamp());
 
   EXPECT_DOUBLE_EQ(2.5, estimator.GetEstimatedPosition().X().value());
   EXPECT_DOUBLE_EQ(0, estimator.GetEstimatedPosition().Y().value());
@@ -491,7 +491,8 @@ TEST(SwerveDrivePoseEstimator3dTest, TestReset) {
                    estimator.GetEstimatedPosition().Rotation().Z().value());
 
   // Add a vision measurement with a different rotation
-  estimator.AddVisionMeasurement(frc::Pose3d(2.5_m, 1_m, 0_m, frc::Rotation3d{frc::Rotation2d{180_deg}}),
+  estimator.AddVisionMeasurement(
+      frc::Pose3d(2.5_m, 1_m, 0_m, frc::Rotation3d{frc::Rotation2d{180_deg}}),
       wpi::math::MathSharedStore::GetTimestamp());
 
   EXPECT_DOUBLE_EQ(2.5, estimator.GetEstimatedPosition().X().value());

wpimath/src/test/native/cpp/estimator/SwerveDrivePoseEstimatorTest.cpp

@@ -432,7 +432,7 @@ TEST(SwerveDrivePoseEstimatorTest, TestReset) {
 
   // Add a vision measurement with a different translation
   estimator.AddVisionMeasurement(frc::Pose2d{3_m, 0_m, frc::Rotation2d{}},
-      wpi::math::MathSharedStore::GetTimestamp());
+                                 wpi::math::MathSharedStore::GetTimestamp());
 
   EXPECT_DOUBLE_EQ(2.5, estimator.GetEstimatedPosition().X().value());
   EXPECT_DOUBLE_EQ(0, estimator.GetEstimatedPosition().Y().value());
@@ -462,7 +462,8 @@ TEST(SwerveDrivePoseEstimatorTest, TestReset) {
       estimator.GetEstimatedPosition().Rotation().Radians().value());
 
   // Add a vision measurement with a different rotation
-  estimator.AddVisionMeasurement(frc::Pose2d{2.5_m, 1_m, frc::Rotation2d{180_deg}},
+  estimator.AddVisionMeasurement(
+      frc::Pose2d{2.5_m, 1_m, frc::Rotation2d{180_deg}},
       wpi::math::MathSharedStore::GetTimestamp());
 
   EXPECT_DOUBLE_EQ(2.5, estimator.GetEstimatedPosition().X().value());