https://123dok.com/document/q2kd0ljq-dynamic-body-motion-generation-rigid-contacts-unilateral-constraints.html