https://123dok.net/document/yng0x7gj-algorithms-identifying-rigid-subsystems-geometric-constraint-systems.html