@@ -144,7 +144,6 @@ void cylinderColladaMeshInertiaCalculation(
144
144
145
145
// Check the Inertial Pose and Link Pose. Their world poses should be the
146
146
// same since the inertial pose relative to the link is zero.
147
- EXPECT_EQ (link.WorldPose (*ecm).value (), worldPose (linkEntity, *ecm));
148
147
EXPECT_EQ (link.WorldInertialPose (*ecm).value (),
149
148
worldPose (linkEntity, *ecm) * gz::math::Pose3d::Zero);
150
149
}
@@ -221,9 +220,7 @@ void cylinderColladaMeshWithNonCenterOriginInertiaCalculation(
221
220
EXPECT_TRUE (
222
221
link.WorldInertiaMatrix (*ecm).value ().Equal (inertiaMatrix, 0.005 ));
223
222
224
- // Check the Inertial Pose and Link Pose
225
- EXPECT_EQ (link.WorldPose (*ecm).value (), worldPose (linkEntity, *ecm));
226
-
223
+ // Check the Inertial Pose
227
224
// Since the height of cylinder is 2m and origin is at center of bottom face
228
225
// the center of mass (inertial pose) will be 1m above the ground
229
226
EXPECT_EQ (link.WorldInertialPose (*ecm).value (),
@@ -319,8 +316,7 @@ TEST(MeshInertiaCalculationTest, CylinderColladaOptimizedMeshInertiaCalculation)
319
316
ixxyyzzTol));
320
317
EXPECT_TRUE (actualIxyxzyz.Equal (
321
318
meshInertial.MassMatrix ().OffDiagonalMoments (), 3.5 ));
322
- // Check the Inertial Pose and Link Pose
323
- EXPECT_EQ (link.WorldPose (*ecm).value (), worldPose (linkEntity, *ecm));
319
+ // Check the Inertial Pose
324
320
EXPECT_TRUE (link.WorldInertialPose (*ecm).value ().Equal (
325
321
worldPose (linkEntity, *ecm) * gz::math::Pose3d::Zero, 1e-2 ));
326
322
}
0 commit comments