Thanks for your reply, but i still meet problem about this equation: M * qacc + qfrc_bias not equal to data.qfrc_passive + data.qfrc_actuator + data.efc_JT * efc_force while M is converted by mj_fullM, then reshape to nv*nv