analytical-derivatives automatic-differentiation c-plus-plus casadi code-generation conda cppad dynamics fcl kinematics motion-planning pinocchio python rigid-body-dynamics robotics ros urdf