use new quaternion Equal tolerance method

Signed-off-by: Ashton Larkin <ashton@openrobotics.org>
gazebosim · Mar 15, 2021 · f767938 · f767938
1 parent ae8e1b7
commit f767938
Showing 1 changed file with 1 addition and 4 deletions.
diff --git a/src/systems/physics/Physics.cc b/src/systems/physics/Physics.cc
@@ -250,10 +250,7 @@ class ignition::gazebo::systems::PhysicsPrivate
           pose3Eql { [](const math::Pose3d &_a, const math::Pose3d &_b)
                      {
                        return _a.Pos().Equal(_b.Pos(), 1e-6) &&
-                         math::equal(_a.Rot().X(), _b.Rot().X(), 1e-6) &&
-                         math::equal(_a.Rot().Y(), _b.Rot().Y(), 1e-6) &&
-                         math::equal(_a.Rot().Z(), _b.Rot().Z(), 1e-6) &&
-                         math::equal(_a.Rot().W(), _b.Rot().W(), 1e-6);
+                         _a.Rot().Equal(_b.Rot(), 1e-6);
                      }};
 
   /// \brief AxisAlignedBox equality comparison function.