https://123dok.net/document/qmjlwn4q-rigid-body-dynamics-scalable-body-quaternions-perfect-constraints.html