Skip to content

Commit 6416e54

Browse files
Merge pull request #2348 from jjyyxx:patch-3
PiperOrigin-RevId: 785518837 Change-Id: I2bbdcb6aea0ff3edfa354389ef758c2d34b93f68
2 parents 3901dcd + 5fa6b43 commit 6416e54

File tree

1 file changed

+3
-3
lines changed

1 file changed

+3
-3
lines changed

src/engine/engine_vis_visualize.c

Lines changed: 3 additions & 3 deletions
Original file line numberDiff line numberDiff line change
@@ -207,6 +207,9 @@ static void addContactGeom(const mjModel* m, mjData* d, const mjtByte* flags,
207207
FINISH
208208
}
209209

210+
// mat = contact frame rotation matrix (normal along x)
211+
mju_transpose(mat, con->frame, 3, 3);
212+
210213
// contact frame
211214
if (vopt->frame == mjFRAME_CONTACT) {
212215
// set length and width of axis cylinders using half regular frame scaling
@@ -244,9 +247,6 @@ static void addContactGeom(const mjModel* m, mjData* d, const mjtByte* flags,
244247
continue;
245248
}
246249

247-
// mat = contact frame rotation matrix (normal along x)
248-
mju_transpose(mat, con->frame, 3, 3);
249-
250250
// get contact force:torque in contact frame
251251
mj_contactForce(m, d, i, confrc);
252252

0 commit comments

Comments
 (0)