本算法利用A*算法实现路径规划,适用于三维场景。