https://123dok.net/document/yd78812g-tdeclarative-solutions-manipulation-articulated-objects-using-dual-robots.html