https://123dok.net/document/yj7rw7v6-constraint-graphs-unifying-planning-navigation-manipulation-movable-obstacles.html