本程序基于MATLAB语言，主要实现的是路径规划的问题，实现三维环境下对运动路径的最优规划。