高空作业平台激光雷达与惯导融合定位建图装置及方法制造方法及图纸

本发明专利技术提供一种高空作业平台激光雷达与惯导融合定位建图装置及方法，装置包括三维激光雷达、IMU惯性传感器、电源、计算主控单元、时间同步系统和支架；所述装置与斗臂车升降平台的末端刚性固定，随工作斗进行移动，所述三维激光雷达扫描环境，所述IMU惯性传感器进行预积分获取旋转和位移增量，将点云数据和IMU惯性传感器数据反馈到所述计算主控单元，分别进行相邻帧匹配得到激光里程计，接着进行全局因子图优化，最后进行回环检测将运算结果融合构建地图。本发明专利技术可提升高空作业平台的感知能力和自主性，使其具备环境理解能力，从而规避危险作业行为。险作业行为。险作业行为。

【技术实现步骤摘要】
高空作业平台激光雷达与惯导融合定位建图装置及方法


[0001]本专利技术涉及高空作业机械的智能定位
，具体涉及一种应用于高空作业机械的惯性导航和激光雷达紧融合定位建图装置及方法。

技术介绍

[0002]激光雷达，是激光探测与测距系统的简称，它通过测定传感器发射器与目标物体之间的传播距离，分析目标物体表面的反射能量大小、反射波谱的幅度、频率和相位等信息，从而呈现出目标物精确的三维结构信息，激光雷达数据通常以点云形式呈现，数据包保存环境点XYZ的空间坐标。惯性测量单元，简称IMU，是测量物体三轴姿态角(或角速率)以及加速度的装置。一个IMU内通常会装有三轴的陀螺仪和三个方向的加速度计，来测量物体在三维空间中的角速度和加速度，并以此解算出物体的姿态。为了提高可靠性，还可以为每个轴配备更多的传感器如三轴磁力计，高度计等。在机器人领域，激光雷达和IMU可用于机器人的感知系统，帮助机器人进行自身位姿的确定及周围环境的感知和重建。
[0003]通过激光雷达和惯性单元融合实现高空作业平台的实时建图定位主要有以下挑战：空旷的高空环境约束条件减少，激光里程失效；卡车平台、液压臂的高频振动和低频晃动使得传感器精度下降；高空平台突然的升降和旋转考验算法面对运动突变的鲁棒性，本专利技术从硬件系统和软件系统两方面针对高空作业场景的挑战进行完善。

技术实现思路

[0004]为解决现有激光SLAM方法应用于高空作业平台精度不高，鲁棒性低的问题，本专利技术提供一种应用于高空作业机械的惯性导航和激光雷达紧融合定位建图装置及方法。本专利技术创造性地将激光雷达和惯性导航单元(IMU)引入高空作业领域，有效解决了现有高空作业的主要设备高空作业车在应用场景中由于操作和感知几乎完全依赖于工人的经验所带来的高空挤压、高压触电、地面行走倾倒、违规操作等风险，提升了高空作业工程机械的智能化水平及安全性。
[0005]为达到上述目的，本专利技术采用的技术方案为：
[0006]一种高空作业平台激光雷达与惯导融合定位建图装置，包括三维激光雷达、IMU惯性传感器、电源、计算主控单元、时间同步系统和支架；所述装置与斗臂车升降平台的末端刚性固定，随工作斗进行移动，当斗臂车开始工作，操纵液压臂控制旋转和升降，所述装置在升降开始时刻同步开机，所述三维激光雷达扫描环境，所述IMU惯性传感器进行预积分获取旋转和位移增量，将点云数据和IMU惯性传感器数据反馈到所述计算主控单元，分别进行相邻帧匹配得到激光里程计，接着进行全局因子图优化，最后进行回环检测将运算结果融合构建地图，通过后端非线性优化得到所述装置整体运动信息，确定工作斗实时位姿态；随着高空作业平台运动，平台定位和环境建图同步完成，经过时间同步的所述IMU惯性传感器的9轴数据和所述三维激光雷达的数据经过激光运动畸变校正模块、特征提取模块、IMU预积分模块、地图优化模块，最终输出高空作业平台实时的位置和姿态及工作环境的地图。
[0007]本专利技术还提供一种高空作业平台激光雷达与惯导融合定位建图方法，所述定位建图方法通过前端数据采集模块、基于FPGA的数据预处理及时间同步模块和运行机器人操作系统的主控计算模块实现；
[0008]所述前端数据采集模块由三维激光雷达和IMU惯性传感器刚性连接组成，所述三维激光雷达使用多线激光探测器得到360度3D点云图像，所述多线激光探测器通过电机快速旋转以扫描周围环境；所述多线激光探测器每秒发射数千次，提供丰富的3D点云；雷达数据盒通过数字信号处理和波形分析提供高精度、可扩展的距离探测和强度数据；
[0009]基于FPGA的数据预处理及时间同步模块对数据进行预处理，所述数据包括三维激光雷达的UDP网络数据包，经过基于FPGA的数据预处理模块内的时间戳被赋值，经过预处理的三维激光雷达的UDP网络数据包发送至工控机的计算主控单元；所述数据还包括惯性导航模块的串口数据包，其时间信息字段经过基于FPGA的数据预处理模块被赋值，经过预处理的惯导串口数据包发送至工控机的计算主控单元，所述时间同步模块进行三维激光雷达、IMU惯性传感器和主控计算模块的时间同步；
[0010]所述主控计算模块运行的算法包括激光运动畸变校正模块、特征提取模块、IMU预积分模块和地图优化模块。
[0011]进一步地，所述三维激光雷达以不小于5Hz的更新速率发布点云数据，所述三维激光雷达为机械旋转式激光雷达、固态激光雷达、MEMS激光雷达或数字激光雷达。
[0012]进一步地，所述IMU惯性传感器以不小于200Hz的速率更新9轴数据，分别反映所述装置的三轴姿态角、三轴加速度和三轴角速度。
[0013]进一步地，所述时间同步模块的第一级为GNSS接收模块，通过卫星获取纳秒级精度的UTC真值时间数据，FPGA以低延时逻辑并行电路处理授时信息，将GNSS信号转化为PPS信号和NEMA信号，所述三维激光雷达接入两个信号进行时间同步，同时将PPS信号接入IMU模块，使IMU惯性传感器的惯性数据时间戳与UTC真值时间保持一致。主控计算模块接受由FPGA转化发送的NDT网络数据包，通过NDT协议进行时间同步。
[0014]进一步地，所述激光运动畸变模块通过斗臂车上固定的IMU惯性传感器获取数据并对三维激光雷达的位姿进行粗略的初始化，利用相对于激光帧起始时刻的位姿增量，变换当前激光点到起始时刻激光点的坐标系下，实现对激光帧的矫正。
[0015]进一步地，所述特征提取模块通过高空中的三维激光雷达采集的点云数据计算每个点的曲率，并设置相应的阈值，比较阈值和曲率后提取出角点和平面点。
[0016]进一步地，所述IMU预积分模块用于获取高空作业时的旋转、平移的IMU惯性传感器增量。
[0017]进一步地，所述地图优化模块首先根据所述特征提取模块获得的特征点进行相邻数据之间的帧间匹配，包括提取当前激光帧特征点，局部关键帧对应的高空地图的特征点，执行当前帧和高空地图迭代优化，更新当前帧位姿；其次，进行关键帧因子图优化，在关键帧加入因子图，添加激光里程计因子、GPS因子、闭环因子，执行因子图优化，更新所有关键帧位姿；最后进行闭环检测，在历史关键帧中找距离相近、时间相隔较远的帧设为匹配帧，在所述匹配帧周围提取局部关键帧，同样执行单帧扫描到全局地图匹配，得到位姿变换，构建闭环因子数据，加入因子图优化。
[0018]有益效果：
[0019]本专利技术针对传统高空作业平台在工作过程中因为智能化程度不足，依赖人为经验所带来的危险及痛点，引入机器人定位导航技术，选取了可以反映物体运动信息及姿态的惯性传感器(IMU)及三维感知精度高、抗干扰能力强、信息丰富的激光雷达作为传感模块，两种传感器优势互补，通过高同步性的硬件及高精度的融合算法实现定位建图功能，很好地适应了高空作业场景下的需求，实现了高空作业平台实时、准确的定位及工作场景的场景理解。相较于只使用IMU或激光雷达的定位或建图方案精度和鲁棒性均有明显提升。
附图说明
[0020]图1为本专利技术的高空作业平台激光雷达与惯导融合定位建图本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种高空作业平台激光雷达与惯导融合定位建图装置，其特征在于：包括三维激光雷达、IMU惯性传感器、电源、计算主控单元、时间同步系统和支架；所述装置与斗臂车升降平台的末端刚性固定，随工作斗进行移动，当斗臂车开始工作，操纵液压臂控制旋转和升降，所述装置在升降开始时刻同步开机，所述三维激光雷达扫描环境，所述IMU惯性传感器进行预积分获取旋转和位移增量，将点云数据和IMU惯性传感器数据反馈到所述计算主控单元，分别进行相邻帧匹配得到激光里程计，接着进行全局因子图优化，最后进行回环检测将运算结果融合构建地图，通过后端非线性优化得到所述装置整体运动信息，确定工作斗实时位姿态；随着高空作业平台运动，平台定位和环境建图同步完成，经过时间同步的所述IMU惯性传感器的9轴数据和所述三维激光雷达的数据经过激光运动畸变校正模块、特征提取模块、IMU预积分模块、地图优化模块，最终输出高空作业平台实时的位置和姿态及工作环境的地图。2.一种根据权利要求1所述的高空作业平台激光雷达与惯导融合定位建图装置的定位建图方法，其特征在于：所述定位建图方法通过前端数据采集模块、基于FPGA的数据预处理及时间同步模块和运行机器人操作系统的主控计算模块实现；所述前端数据采集模块由三维激光雷达和IMU惯性传感器刚性连接组成，所述三维激光雷达使用多线激光探测器得到360度3D点云图像，所述多线激光探测器通过电机快速旋转以扫描周围环境；所述多线激光探测器每秒发射数千次，提供丰富的3D点云；雷达数据盒通过数字信号处理和波形分析提供高精度、可扩展的距离探测和强度数据；基于FPGA的数据预处理及时间同步模块对数据进行预处理，所述数据包括三维激光雷达的UDP网络数据包，经过基于FPGA的数据预处理模块内的时间戳被赋值，经过预处理的三维激光雷达的UDP网络数据包发送至工控机的计算主控单元；所述数据还包括惯性导航模块的串口数据包，其时间信息字段经过基于FPGA的数据预处理模块被赋值，经过预处理的惯导串口数据包发送至工控机的计算主控单元，所述时间同步模块进行三维激光雷达、IMU惯性传感器和主控计算模块的时间同步；所述主控计算模块运行的算法包括激光运动畸变校正模块、特征提取模块、IMU预积分模块和地图优化模块。3.根据权利要求2所...

【专利技术属性】
技术研发人员：董二宝，王梓名，刘昱江，李勇，李笋，张用，张磊，吴少雷，吴凯，
申请(专利权)人：国网山东省电力公司电力科学研究院国网安徽省电力有限公司电力科学研究院，
类型：发明
国别省市：