井下车辆同步定位与地图构建方法、系统和介质
摘要:
本发明涉及无人驾驶地图实时构建技术领域,尤其涉及一种井下车辆同步定位与地图构建方法及系统,方法包括:S1,通过激光雷达装置获取激光雷达数据,对激光雷达数据进行处理,得到点云场景特征;S2,通过IMU里程计获取IMU数据,对IMU数据进行处理,得到当前姿态信息;S3,对点云场景特征和当前姿态信息进行联合标定,并统一坐标;S4,结合点云场景特征和当前姿态信息进行联合优化,获取车辆的运动轨迹;S5,根据运动轨迹对点云地图更新,构建高精度地图,本发明的井下车辆同步定位与地图构建方法,用于井下车辆自动驾驶,能够实现同步定位与地图构建,且构建的地图质量好。
0/0