@@ -1324,7 +1324,7 @@ TEST_F(PhysicsSystemFixture, NestedModelIndividualCanonicalLinks)
1324
1324
EXPECT_EQ (6u , postUpModelPoses.size ());
1325
1325
1326
1326
auto modelIt = postUpModelPoses.find (" model_00" );
1327
- EXPECT_NE (postUpModelPoses.end (), modelIt);
1327
+ ASSERT_NE (postUpModelPoses.end (), modelIt);
1328
1328
1329
1329
// link_00 is resting on the ground_box, so it remains stationary. And since
1330
1330
// it is the canonical link of the parent model, model_00, the model frame
@@ -1338,25 +1338,26 @@ TEST_F(PhysicsSystemFixture, NestedModelIndividualCanonicalLinks)
1338
1338
const double dt = 0.001 ;
1339
1339
const double zExpected = 0.5 * world->Gravity ().Z () * pow (dt * iters, 2 );
1340
1340
modelIt = postUpModelPoses.find (" model_01" );
1341
- EXPECT_NE (postUpModelPoses.end (), modelIt);
1341
+ ASSERT_NE (postUpModelPoses.end (), modelIt);
1342
1342
EXPECT_NEAR (zExpected, modelIt->second .Z (), 1e-2 );
1343
1343
1344
- // model_10, model_11 and model_12 share the same canonical link (link_11 ),
1345
- // which is a floating link. So, link_11 should fall due to gravity, which
1344
+ // model_10, model_11 and model_12 share the same canonical link (link_12 ),
1345
+ // which is a floating link. So, link_12 should fall due to gravity, which
1346
1346
// also means that the frames for model_10, model_11 and model_12 should fall
1347
1347
auto model10It = postUpModelPoses.find (" model_10" );
1348
- EXPECT_NE (postUpModelPoses.end (), model10It);
1348
+ ASSERT_NE (postUpModelPoses.end (), model10It);
1349
1349
EXPECT_NEAR (zExpected, model10It->second .Z (), 1e-2 );
1350
1350
auto model11It = postUpModelPoses.find (" model_11" );
1351
- EXPECT_NE (postUpModelPoses.end (), model11It);
1351
+ ASSERT_NE (postUpModelPoses.end (), model11It);
1352
1352
auto model12It = postUpModelPoses.find (" model_12" );
1353
- EXPECT_NE (postUpModelPoses.end (), model12It);
1353
+ ASSERT_NE (postUpModelPoses.end (), model12It);
1354
1354
// (since model_11 and model_12 are nested, their poses are computed w.r.t.
1355
1355
// model_10)
1356
1356
EXPECT_DOUBLE_EQ (0.0 , model11It->second .Z ());
1357
1357
EXPECT_DOUBLE_EQ (0.0 , model12It->second .Z ());
1358
1358
// check the world pose of model_11 and model_12 to make sure the z components
1359
1359
// of these world poses match zExpected
1360
+ ASSERT_NE (nullptr , ecm);
1360
1361
const auto model11Entity =
1361
1362
ecm->EntityByComponents (components::Name (model11It->first ));
1362
1363
ASSERT_NE (kNullEntity , model11Entity);
0 commit comments