hpp-affordance 4.12.0 Extract Whole-Body Affordances for Multi-Contact Planning Guilhem Saurel BSD Anna Seppala catkin