chenlin/Mujoco_WASM
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Fix comparison in engine_core_constraint_test.

Browse Source 
(was comparing number to itself)

PiperOrigin-RevId: 705053943
Change-Id: I3d179ab4bb2ed1bc1b74b4edec7ce1114ad16b37
This commit is contained in:
Yuval Tassa
2024-12-11 04:10:06 -08:00
committed by Copybara-Service
parent 049a260102
commit 3ca97248a3
1 changed files with 10 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files
test/engine/engine_core_constraint_test.cc
+10 -6
View File
@@ -477,6 +477,7 @@ TEST_F(CoreConstraintTest, MulJacTVecIsland) {
mj_deleteModel(model); mj_deleteModel(model);
} }
// compare mj_constraintUpdate and mj_constraintUpdate_island
TEST_F(CoreConstraintTest, ConstraintUpdateIsland) { TEST_F(CoreConstraintTest, ConstraintUpdateIsland) {
const std::string xml_path = GetTestDataFilePath(kIlslandEfcPath); const std::string xml_path = GetTestDataFilePath(kIlslandEfcPath);
mjModel* model = mj_loadXML(xml_path.c_str(), nullptr, nullptr, 0); mjModel* model = mj_loadXML(xml_path.c_str(), nullptr, nullptr, 0);
@@ -557,12 +558,15 @@ TEST_F(CoreConstraintTest, ConstraintUpdateIsland) {
} }
// compare cone Hessians // compare cone Hessians
for (int c=0; c < data2->ncon; c++) { if (cone == mjCONE_ELLIPTIC) {
int efcadr = data2->contact[c].efc_address; for (int c=0; c < data2->ncon; c++) {
if (data2->efc_island[efcadr] == island) { int efcadr = data2->contact[c].efc_address;
for (int j=0; j < 36; j++) { if (data2->efc_island[efcadr] == island &&
EXPECT_THAT(data2->contact[c].H[j], data2->efc_state[efcadr] == mjCNSTRSTATE_CONE) {
DoubleNear(data2->contact[c].H[j], 1e-12)); for (int j=0; j < 36; j++) {
EXPECT_THAT(data2->contact[c].H[j],
DoubleNear(data1->contact[c].H[j], 1e-12));
}
} }
} }
} }