reload the centroidal dynamics function in ManipulationCentroidalDynamicsFullKinematicsPlanner