Forked from
Humanoid Path Planner / hpp-manipulation
223 commits behind the upstream repository.
The graph has loop edge for every state (node), which can be used to connect init and goal config directly if they are both in the same state.