运动规划中的优化算法(Numerical Optimization)及其拓展和应用