Merge branch 'master' into hand_grasping_demo
a new plan to move the object, still no collision avoidance
Merge branch 'hand_grasping_demo' into update-centroidal-planner