在别人3D路径规划上改的,matlab程序。还是比较好用的。可以借鉴修改,布谷鸟算法、遗传算法、大家可以借鉴。有很多资料的。