摘要
轻小型穿戴式激光扫描系统具有成本低、体积小、易操作的特点,为室内外一体化三维地理信息获取提供了一种可行方案,是传统移动测量系统的有效补充。相比现有手持及背包激光扫描系统,基于头盔的观测平台与用户视线保持方向一致,具有“所见即所得”的特点,让作业人员双手得到了解放。以自主研发的头盔式激光扫描系统“WHU-Helmet”为对象,设计了基于多尺度正态分布变换的LiDAR-IMU SLAM算法,实现了在室内外环境无缝的实时三维点云数据获取。以两个典型室内外环境为实验区域(办公楼、地铁站),将“WHU-Helmet”获取的三维点云与地面式激光扫描系统获取的三维点云对比,平均误差小于 0.44 m,均方根误差小于 0.23 m,表明了头盔式激光扫描系统在室内外一体化三维测图中具有巨大的潜力。
建设智慧城市需依靠室内外三维全空间地理信息数据为桥梁,从而搭建现实物理世界与虚拟网络世界之间双向映射,形成虚实结合的城市治理模式,对提升我国城市可持续发展能力具有重要意
随着众源地理信息获取装
本文研发的头盔式激光扫描系统硬件组成如

图1 头盔式激光扫描系统硬件描述
Fig.1 Hardware description of the helmet-based laser scanning system
系统中主要涉及激光雷达坐标系(FL),载体坐标系(FB与IMU三轴对齐),局部制图坐标系(FM)。在t时刻,需要估计的系统状态为。其中包括载体位置、速度、姿态四元数 (对应旋转矩阵为)、加速度计零偏、角速度计零偏。在激光雷达中的一个观测点,可通过载体位置与姿态,及激光雷达安置参数(安置角,杆臂值),根据
(1) |
本文提出的基于多尺度正态分布变换的实时LiDAR-IMU SLAM 流程如

图2 多尺度正态分布(NDT)变换的实时LiDAR-IMU SLAM流程
Fig.2 Flowchart for the multi-scale real-time normal distributions transform(NDT)based LiDAR-IMU SLAM
由于LiDAR连续扫描特性,第k帧(一般为0.1s内的扫描数据) LiDAR数据存在由于剧烈运动导致的运动畸变效应,采用可利用单帧激光扫描时间内的IMU数据对系统运动进行补偿,将单帧内的点云数据转换至初始扫描位置,从而消除单帧激光扫描运动畸变。利用IMU获取运动补偿姿态采用预积分
(2) |
(3) |
(4) |
式中:、分别为加速度和角速度观测;为重力加速度;为轴角到纯虚四元数的转换 。,和分别为位置、速度和角度预积分项,即第帧激光扫描时间内载体的相对运动,可直接用于补偿激光扫描运动畸变。
NDT是常用于LiDAR SLAM的匹配与三维地图表达方式,相比于基于线、面特征的SLAM方法,无需提取几何特征,在复杂退化环境或没有规则几何结构的环境中具有较好的表现,且整体计算量可
(5) |
对于搭载在头盔式激光扫描系统中的固态激光雷达,其扫描获取的单帧点云内部点密度存在较大差异,距离扫描中心较近处点密度大,相反距扫描中心较远处点密度小,如

图3 固态激光雷达扫描点云示意图
Fig.3 Scanning pattern of the solid-state LiDAR
本文采取多尺度正态分布变换以克服上述体素尺寸设置难题,步骤如下:
(1)设置体素尺寸为(实验中为0.5 m), 对单帧点云进行均匀体素化,并计算每一个体素中的均值、方差、点数、特征向量、空间范围,依据特征向量判断体素几何属性(线性、面性、不规则
(2)对体素进行迭代合并,合并条件见
(3) 将合并后的体素内所有参数更新。
以面性体素合并为例,如

图4 多尺度NDT合并条件示意俯视图
Fig.4 Illustration of the multi-scale NDT merging conditions
在实时估计头盔式激光扫描系统的状态参数时,需考虑两种模态信息,即IMU对运动的高频观测约束以及激光与地图的匹配约束。考虑到系统运行的实时性需求,采用滑动窗
(6) |
详细实现如下:
(1) IMU预积分约束
IMU信息在SLAM系统中除了可以用于运动畸变矫正外,其预积分得到的相对姿态、位置信息也可用于计算头盔式激光扫描系统的状态量。第帧激光和第帧激光之间所有的预积分项,和可构成如
(7) |
(2) LiDAR匹配约束
对于第k帧点云中的一个三维点,根据当前位姿及
(8) |
(3) 边缘化约束
利用滑动窗口限制SLAM系统实时优化的参数量从而保证系统的实时计算能力。当一帧新的激光帧到来时,SLAM系统将为其创建一组新的系统状态量,并删除最旧的系统状态量及相关约束条件,从而保证SLAM系统中优化的参数量固定不变。为了在删除最旧状态量与相关约束条件的过程中保留对当前系统状态量的约束,降低信息损失,本文利用舒尔补进行先验信息提
(9) |
式中:为Hessian矩阵;为改正数,为误差项。将分成两部分, 式中为需要删除的最老状态量,而为需要保留的待优化状态量。
(10) |
依据舒尔补,
(11) |
从
从而获得边缘化约束:
(12) |
本文实验区域选取了两个典型城市场景,包括办公楼和地铁站,用于室内外一体化无缝测图实验(如

图5 试验区域
Fig.5 Study area

图6 头盔及手持激光作业示意图
Fig.6 Illustration of data acquisition using the helmet and a handheld scanner

图7 广埠屯地铁站室内外一体化三维点云地图
Fig.7 Outdoor and indoor 3D point cloud map of computer-town subway station

图8 星湖楼室内外一体化三维点云地图
Fig.8 Outdoor and indoor 3D point cloud map of Xinghu building

图9 手持激光点云星湖楼室内点云地图
Fig.9 Point cloud collected by the handheld laser scanner in Xinghu building
为了验证头盔式激光扫描系统在室内外三维一体化测图的精度,本文利用地面激光扫描仪(Riegl VZ-400)在实验环境中进行扫描并进行多站扫描数据拼接。拼接后的多站激光扫描数据作为基准。人工在两个实验场景中分别选取30个均匀分布的特征点,并建立其在地面激光扫描数据与头盔式激光扫描数据中的匹配关系,从而衡量头盔式激光扫描系统的精度。两个场景中的同名点误差分布如

图10 特征点误差分布
Fig.10 Error distribution of the selected corresponding points
对比手持激光扫描和头盔激光扫描在室内获取的点云数据的完整度可以发现,头盔激光扫描获取的点云密度在建筑物顶面和地面更加均匀、稠密,这是由于不同激光器扫描的模式造成的。这是由于上述结果说明了头盔式激光扫描系统在室内外三维一体化无缝测图中具有巨大的潜力。
轻小型穿戴式激光扫描系统具有成本低、体积小、易操作的特点,是传统激光扫描系统的有效补充,可在通行受限区域获取三维空间数据。本文自主设计了头盔式激光扫描系统“WHU-Helmet”,提出基于多尺度正态分布变换的实时LiDAR-IMU SLAM方法,并以典型室内外环境为实验区域,以验证头盔式激光扫描系统在室内外一体化三维测图的精度与可行性。通过将“WHU-Helmet”获取的三维数据与地面式激光扫描系统获取的三维点云对比,“WHU-Helmet”获取的点云平均误差小于 0.44 m,均方根误差小于 0.23 m。头盔式激光扫描系统对导航信息无依赖,三维测图自动化程度高,在室内外三维一体化测图中有着巨大潜力。在未来的工作中,将以室内外结构化信息自动提取为研究点,利用结构约束信息提升穿戴式系统的三维测图精度。
作者贡献声明
李健平:实现方法,完成实验,撰写论文。
杨必胜:提供方法思路,指导模型构建,实验数据处理及论文撰写。
参考文献
李德仁. 从测绘学到地球空间信息智能服务科学 [J]. 测绘学报. 2017, 46 (10):1207. [百度学术]
LI Deren. From geomatics to geospatial intelligent service science [J]. Acta Geodaetica et Cartographica Sinica, 2017, 46 (10):1207 [百度学术]
杨必胜, 董震. 点云智能处理[M]. 北京:科学出版社,2020 [百度学术]
YANG Bisheng, DONG Zhen.Point cloud intelligent processing [M].Beijing: Chinese Science Publishing, 2020 [百度学术]
杨必胜, 董震. 点云智能研究进展与趋势 [J]. 测绘学报,2019, 48 (12):1575. [百度学术]
YANG Bisheng, DONG Zhen. Progress and perspective of point cloud intelligence [J]. Acta Geodaetica et Cartographica Sinica,2019, 48 (12): 1575. [百度学术]
杨必胜, 梁福逊, 黄荣刚. 三维激光扫描点云数据处理研究进展, 挑战与趋势 [J]. 测绘学报, 2017, 46 (10):1509. [百度学术]
YANG Bisheng, LIANG Fuxun, HUANG Ronggang. Progress, challenges and perspectives of 3D LiDAR point cloud processing [J]. Acta Geodaetica et Cartographica Sinica,2017, 46 (10):1509. [百度学术]
李清泉, 张德津, 汪驰升, 等. 动态精密工程测量技术及应用 [J]. 测绘学报, 2021, 50 (9):1147. [百度学术]
LI Qingquan, ZHANG Dejing, WANG Chishen, et al. Technology and applications of dynamic and precise engineering [J]. Acta Geodaetica et Cartographica Sinica,2021, 50 (9):1147. [百度学术]
叶勤, 刘行, 姚亚会, 等. 便携式 RGB-D 传感器深度测量与建模精度研究 [J]. 同济大学学报 (自然科学版),2019, 47 (6):870. [百度学术]
YE Qin, LIU Xing, YAO Yahui, et al. Study on depth measurement and 3D reconstruction accuracy based porable RGB-D sensor [J]. Journal of Tongji University(Natural Science), 2019, 47 (6):870. [百度学术]
龚健雅. 人工智能时代测绘遥感技术的发展机遇与挑战 [J]. 武汉大学学报(信息科学版),2018, 43 (12):1788. [百度学术]
GONG Jianya. Changes and challenges for development of surveying and remote sensing in the age of artificial intelligence [J]. Geomatics and Information Science of Wuhan University,2018, 43 (12):1788. [百度学术]
杨必胜, 李健平. 轻小型低成本无人机激光扫描系统研制与实践 [J]. 武汉大学学报(信息科学版),2018, 43 (12):1972. [百度学术]
YANB Bisheng, LI Jianping. Implementation of a low-cost mini-UAV laser scanning system [J].Geomatics and Information Science of Wuhan University,2018, 43 (12):1972. [百度学术]
ZHU Y, ZHENG C, YUAN C, et al. Camvox: A low-cost and accurate lidar-assisted visual slam system [C]// IEEE International Conference on Robotics and Automation (ICRA). [S.l]:IEEE,2021:5049-5055. [百度学术]
DEWEZ T J, YART S, THUON Y, et al. Towards cavity‐collapse hazard maps with Zeb‐Revo handheld laser scanner point clouds [J]. The Photogrammetric Record,2017, 32 (160):354. [百度学术]
SHAO J, ZHANG W, LUO L, et al. SLAM-based backpack laser scanning for forest plot mapping [J]. ISPRS Annals of Photogrammetry, Remote Sensing & Spatial Information Sciences, 2020, 5 (2):267 [百度学术]
袁浛天, 张景刚, 李蔚清, 等. 面向 AR 虚实士兵对抗训练的分布式感知技术 [J]. 计算机仿真,2020,37 (6):13. [百度学术]
YUAN Hantian, ZHANG Jinggang, LI Weiqing, et al. The perception technology in ar confrontation system for virtual and real force [J]. Computer Simulation,2020, 37 (6):13. [百度学术]
LI J, YANG B, CHEN C, et al. NRLI-UAV: Non-rigid registration of sequential raw laser scans and images for low-cost UAV LiDAR point cloud quality improvement [J]. ISPRS Journal of Photogrammetry and Remote Sensing,2019, 158: 123. [百度学术]
LI J, YANG B, CHEN C, et al. Aerial-triangulation aided boresight calibration for a low-cost UAV-LiDAR system [J]. ISPRS Annals of the Photogrammetry, Remote Sensing and Spatial Information Sciences, 2020,5( 1 ):245. [百度学术]
QIN T, LI P, SHEN S. Vins-mono: A robust and versatile monocular visual-inertial state estimator [J]. IEEE Transactions on Robotics, 2018, 34 (4):1004. [百度学术]
MAGNUSSON M, LILIENTHAL A, DUCKETT T. Scan registration for autonomous mining vehicles using 3D‐NDT [J]. Journal of Field Robotics, 2007, 24 (10):803. [百度学术]
MAGNUSSON M. The three-dimensional normal-distributions transform: an efficient representation for registration, surface analysis, and loop detection [D]. Örebro: Örebro Universitet,2009. [百度学术]
HUANG G P, MOURIKIS A I, ROUMELIOTIS S I. An observability-constrained sliding window filter for SLAM [C]// 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems. [S.l]:IEEE,2011:65-72. [百度学术]
YANG Y, MALEY J, HUANG G. Null-space-based marginalization: analysis and algorithm [C]// 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). [S.l]:IEEE,2017:6749-6755. [百度学术]