restructure the ComDynamicsFullKinematicsPlanner, now its centroidal dynamics can be reloaded
change the structure of SimpleDynamicsFullKinematics, now the ComDynamicsFullKinematics can derive new class
add a ManipulationCentroidalDynamicsFullKinematicsPlanner, that only enforce centroidal dynamics for the right body object being grasped