https://github.com/ros-planning/moveit_tutorials/blob/master/doc/chomp_planner/chomp_planner_tutorial.rst matlab:Covariant Hamiltonian optimizer for rigid body tree motion planning - MATLAB- MathWorks 中国