刚开始研究路径规划,因为要研究三维的,所以将二维的A*算法简单改为三维,对自己是一个备份,写的不好,轻喷,可以相互交流