This patch should solve the following remaining issue mentioned in the previous PR.
(I don't see the benefit of keeping qInit or alphaInit explicitly, so I deleted them and directly set data->qpos or data->qvel, but please correct me if I'm wrong)
For now we still don't allow a mismatch between the kinematic structure in mc_rtc and the kinematic structure in the corresponding MuJoCo model, this would require a little extra work to handle the gaps in qpos/qvel
This patch should solve the following remaining issue mentioned in the previous PR. (I don't see the benefit of keeping
qInit
oralphaInit
explicitly, so I deleted them and directly setdata->qpos
ordata->qvel
, but please correct me if I'm wrong)