基于三维激光雷达的电力巡检机器人系统及建图方法

摘要

本发明公开了一种基于三维激光雷达的电力巡检机器人系统及建图方法，本发明的系统架构，包括硬件控制层、硬件驱动层、建图与定位算法层，该方法包括：获取所述三维激光雷达扫描得到的3D点云数据、将3D点云进行2D化数据处理；获取所述2D化点云数据、通过轮式里程计得到的机器人的位置数据和通过惯性测量单元得到的机器人的姿态数据，既机器人的预测位姿、通过2D点云反向确定出的机器人的位置数据和姿态数据，既机器人的观测位姿；通过CSM方法匹配机器人的观测位姿和预测位姿求得机器人的真实位置、姿态数据，获取所述2D点云数据中的各个激光点的实际坐标；基于所述2D点云数据中的各个激光点的实际坐标，生成第一地图。