https://123dok.net/document/zlgr1ngy-formal-foundations-of-3d-geometry-to-model-robot-manipulators.html