Merge pull request #2348 from jjyyxx:patch-3

PiperOrigin-RevId: 785518837
Change-Id: I2bbdcb6aea0ff3edfa354389ef758c2d34b93f68

src/engine/engine_vis_visualize.c

@@ -207,6 +207,9 @@ static void addContactGeom(const mjModel* m, mjData* d, const mjtByte* flags,
       FINISH
     }
 
+    // mat = contact frame rotation matrix (normal along x)
+    mju_transpose(mat, con->frame, 3, 3);
+
     // contact frame
     if (vopt->frame == mjFRAME_CONTACT) {
       // 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,
       continue;
     }
 
-    // mat = contact frame rotation matrix (normal along x)
-    mju_transpose(mat, con->frame, 3, 3);
-
     // get contact force:torque in contact frame
     mj_contactForce(m, d, i, confrc);