hpp-centroidal-dynamics 4.12.0 Testing equilibrium of a system in contact with the environment Guilhem Saurel BSD Andrea Del Prete Pierre Fernbach Steve Tonneau catkin