一种三维地形建模分析与自适应导航系统及方法

本发明公开一种三维地形建模分析与自适应导航系统及方法，涉及导航技术领域。所述系统中激光雷达用于实时获取待导航装置所处区域的点云数据；IMU用于实时测量待导航装置的加速度和角速度；数据融合子模块用于实时对点云数据、加速度和角速度进行预处理，并将预处理后的数据进行融合；三维地图建模子模块用于实时采用SLAM算法根据点云数据构建三维地图模型；三维地形分析模块用于实时确定三维地图模型中各点的地形特征；自适应导航模块用于实时根据三维地图模型和各点的地形特征，对待导航装置进行路径规划，实现导航。本发明可以提高原始数据的精度，进而提高定位精度，实现精准导航。