一种三维空间下的复杂地形导航装置及方法

本发明提出一种三维空间下的复杂地形导航装置及方法。采集地面无人平台所处环境的地形数据；基于所述地形数据实时生成当前环境的三维地图，获取地面无人平台在当前环境的三维地图中相应节点的坐标信息；根据地面无人平台在当前环境的三维地图中的当前节点坐标以及地面无人平台在当前环境的三维地图中的前一节点坐标，利用启发式估计函数预测地面无人平台在当前环境的三维地图中的目标节点坐标；根据当前环境三维地图中的目标节点坐标，规划地面无人平台达到目标节点的运动路径；地面无人平台根据所述运动路径运动至目标节点。本发明构建三维地图并利用智能路径规划，使无人平台能够在复杂地形中实现自主导航和动态避障。实现高效、安全的导航。