Question: Rewritten kinematic constraints with a matrix form


I have a set of 8 kinematic constraints.

I would like to express them into the following form Jxdq with J the jacobian matrix.

I attached my code.

the 8 equations are gathered in SysEq

Thanks a lot for your help

Please Wait...