CN107462897B - 基于激光雷达的三维建图的方法 - Google Patents
基于激光雷达的三维建图的方法 Download PDFInfo
- Publication number
- CN107462897B CN107462897B CN201710598881.5A CN201710598881A CN107462897B CN 107462897 B CN107462897 B CN 107462897B CN 201710598881 A CN201710598881 A CN 201710598881A CN 107462897 B CN107462897 B CN 107462897B
- Authority
- CN
- China
- Prior art keywords
- point
- point cloud
- points
- laser radar
- cloud
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
本发明公开一种基于激光雷达的三维建图的方法,主要解决现有的2D激光雷达在不借助其他传感器辅助的情况下,难以实时绘制精细三维地图的问题。其实现步骤如下:首先获得带有坐标信息的点云;然后使用双边滤波算法对点云进行滤波处理;接着由激光雷达测距算法计算激光雷达点云中每一个特征点的位移;最后用绘图算法将扫描到的点云配准到世界坐标系上,构成三维点云图。本发明仅使用激光雷达和电机组合的平台而不使用其他传感器辅助即可完成实时地构建高质量的三维点云图,可用于移动机器人对地形数据的测绘和对未知环境的探知。
Description
技术领域
本发明属于激光雷达点云处理技术领域,特别涉及激光雷达测绘领域中的一种2D激光雷达实时地进行三维绘图的方法,可用于移动机器人对地形数据的测绘和对未知环境的探知。
背景技术
由于激光雷达对环境光照和场景中的光学纹理不敏感,目前大多数应用使用激光雷达进行定位及绘图。当激光雷达的扫描速率远高于其自身运动时,扫描期间由于运动造成的失真通常可以忽略,在这种情况下,可用标准的ICP算法对激光雷达进行三维建图。然而,在移动的平台上使用激光雷达三维建图是困难的,如果激光雷达的自身运动较快,由于扫描期间激光雷达的运动造成的失真就会严重影响建图。因此在构建点云时,必须同步解算扫描期间移动平台的运动轨迹,否则点云结构将严重失真并且可能无法识别。
J.Hertzberg等人提出了一种采用频繁停止平台运动的方法以进行固定扫描,见Nuchter,A.,Lingemann,K.,Hertzberg,J.,&Surmann,H.6D SLAM-3D mapping outdoorenvironments[J].Journal of Field Robotics,2007.16(4):337-340。这种方法对于大多数的实际应用会很大程度的降低效率。
另一类减少失真的方法是使用其他传感器,比如用惯性测量单元IMU来提供速度和加速度的测量。M.Bosse和R.Zlot等人的方法即使用了IMU辅助建图,见Michael Bosse,Robert Zlot,&Paul Flick.Zebedee:Design of a Spring-Mounted 3-D Range Sensorwith Application to Mobile Mapping[J].IEEE Transactions on Robotics,2012 28(5):1104-1119。他们的平台由2D激光雷达和由弹簧连接到手杆的IMU组成,每次手动点击设备记为一段扫描。该方法使用批量处理优化每段扫描的点云数据集进行绘图,IMU的测量用于记录激光雷达在每段扫描之间的运动轨迹。但是该方法由于需要批量处理来构建高质量的地图,无法实现实时建图,不适用于需要在线建图的应用。
发明内容
本发明的目的在于针对上述已有的技术的不足,提出一种基于激光雷达的三维建图方法,以实时地构建高质量的三维点云图。
本发明的基本思路是避免借助其他传感器的辅助,仅使用2D激光雷达和电机实现三维建图,其方案是:首先获得带有坐标信息的点云Vn,然后使用双边滤波算法对点云进行滤波,接着激光雷达测距算法估算激光雷达点云中每一个特征点的位移;最后绘图算法将扫描到的点云配准到世界坐标系上并输出三维点云图。其实现方案包括如下:
(1)将激光雷达安装在由电机控制的旋转平台上,且以激光雷达当前所在的位置为雷达坐标系的原点,激光雷达的正前方为x轴,雷达坐标系遵循右手定则;
(2)激光雷达输出扫描到的点到原点的距离d、点与原点的连线l和zOy平面的夹角θ1,电机输出l与x轴的夹角θ2;
(3)使用(2)中扫描到的点到原点的距离d、l与zOy平面的夹角θ1和l与x轴的夹角θ2,解算激光雷达点云中每一个点在激光雷达坐标系中的坐标,输出带有坐标信息的点云Vn;
(4)使用双边滤波算法对点云Vn进行滤波处理,输出滤波后的点云Cn;
(5)用激光雷达测距算法对滤波后的点云Cn进行处理,即计算两次连续扫描之间激光雷达点云中每一个特征点的位移;
(6)令开始扫描时激光雷达所在的位置为世界坐标系的原点,利用激光雷达绘图算法将Cn配准到世界坐标系上,构成三维点云图。
本发明具有如下优点:
1)本发明由于使用激光雷达进行三维建图,解决了视觉里程计对环境光照和场景中的光学纹理敏感的问题。
2)本发明由于在三维建图时不需要任何传感器的辅助,仅使用激光雷达和电机组合的平台即可完成三维建图,因此能够极大的降低成本。
3)本发明由于提取激光雷达点云中的特征点较少,所以三维建图的方法运算量较低,具有良好的实时性,适合激光雷达在线地对周围环境三维重建。
附图说明
图1是本发明的实现总流程图;
图2是本发明中提取出来的匹配特征点示意图;
图3是用本发明平台静止不动情况下,使用激光雷达构建的三维点云图;
图4是本发明在以0.5m/s的速度移动的情况下使用激光雷达构建的三维点云图。
以下结合附图对本发明作进一步详细描述。
具体实施方式
参照图1,本发明的实现步骤如下:
步骤1,获得带有坐标信息的点云Vn。
(1a)将激光雷达安装在由电机控制的旋转平台上,且以激光雷达当前所在的位置为雷达坐标系的原点,激光雷达的正前方为x轴,雷达坐标系遵循右手定则;
(1b)激光雷达输出扫描到的点到原点的距离d、点与原点的连线l和zOy平面的夹角θ1,当电机带动激光雷达转动的时候,电机输出l与x轴的夹角θ2;
(1c)使用(1b)中扫描到的点到原点的距离d、l与zOy平面的夹角θ1和l与x轴的夹角θ2,解算激光雷达点云中每一个点在激光雷达坐标系中的坐标,输出带有坐标信息的点云Vn。
步骤2,使用双边滤波算法对点云Vn进行滤波处理。
(2a)令点云Vn中所有点的集合为:Cloud2={p1,p2,…pi…,pn},其中pi为点云Vn中第i个点,i∈(1,n),n为点云Vn中所有点的个数;
假设有一点p∈Cloud2,将与p点最邻近的k个点设为p的k-邻域k(p);
(2b)使用最小二乘法在k-邻域k(p)内构造一个平面,称为点p在k(p)上的切平面S(p);
(2d)将点云Vn中每一个点的坐标通过下式进行滤波:
其中,表示滤波后的点坐标;f表示Vn中需要改正的点的坐标;表示其对应的法矢量估计;L为双边滤波因子,
步骤3,用激光雷达测距算法计算两次连续扫描期间每一个特征点的位移量与旋转角度。
(3a)令α是点云Cn中的点,M是点云Cn中所有点的集合,定义变量h作为α的局部平滑度:
(3b)对点云Cn中每一点的h值进行排序,将h值最大的点选为边缘特征点,h值最小的点选为平面特征点;
(3d1)将(3b)的边缘特征点的集合设为An,如图(2a)所示,令b是An上的点,在点云中找到点b的最邻近点设为j,在点云Cn中找到点b的最邻近点设为 v,用j和v确定一条边缘线(j,v),计算b点到边缘线(j,v)的对应距离,即边缘特征点的位移量dA:
(3d2)将(3b)的平面特征点的集合设为Bn,如图(2b)所示,令r为Bn上的点,在点云中找到点r的最邻近点设为η,在点云Cn中找到r的两个最邻近点设为 u和m,用η、u和m确定平面块(η,u,m),计算r点到平面块(η,u,m)的对应距离,即平面特征点的位移量dB:
步骤4,用激光雷达绘图算法将Cn配准到世界坐标系上,构成三维点云图。
(4a)令第n-1次扫描之前世界坐标系中的点云为Dn-1,将点云Cn转换到世界坐标系中,用Dn表示;
(4d)合并(4b)和(4c)中输出的点云Kn和点云Jn,得到三维点云图。
本发明的效果可以通过以下实验进一步说明。
1.实验条件
本发明采用激光雷达Hokuyo UTM-30LX、电机Dynamixel MX-28分别通过USB连接到笔记本电脑上,在机器人操作系统ROS上运行我们的程序。
2.实验步骤
本发明的实验在室内进行,对两种场景进行三维建图实验:
(2.1)在平台静止不动情况下,使用激光雷达构建三维点云图,结果如图3,其中,图3(a)是从上向下观察的三维点云图,
图3(b)是从后向前观察的三维点云图,
图3(c)是从相同场景拍摄的实景照片。
图3(a)点云上方凸起的部分和图3(b)点云中间密集的部分是大门的轮廓,使用点云图中大门两边门框对应的坐标测算出大门的宽度作为测量值,大门的实际宽度作为实际值。
(2.2)在以0.5m/s的速度移动的情况下,使用激光雷达构建三维点云图,结果如图4,其中
图4(a)是从上向下观察的三维点云图,
图4(b)和4(c)是从相同场景拍摄的实景照片。
从图4(a)点云图中可以清楚的观察图4(b)左上方的窗户和图4(c)中左边的门框的轮廓。使用点云图两边墙壁特征点对应的坐标,测算出点云图中两边墙壁的距离作为测量值,墙壁的实际距离作为真实值。
将(2.1)和(2.2)中的测量值与真实值进行比较,如表1所示。
表1三维点云图中距离测量值与真实值对比
测试场景 | 测量值(cm) | 真实值(cm) | 相对误差 |
大门宽度 | 163.57 | 166.50 | 1.7% |
墙壁距离 | 173.75 | 176.30 | 1.4% |
由表1所示的实验结果可以看出在室内环境中,构建的三维点云图的精度约为2%,说明本发明可以实时地构建高质量的三维点云图。
Claims (3)
1.一种基于激光雷达的三维建图的方法,包括如下步骤:
(1)将激光雷达安装在由电机控制的旋转平台上,且以激光雷达当前所在的位置为雷达坐标系的原点,激光雷达的正前方为x轴,雷达坐标系遵循右手定则;
(2)激光雷达输出扫描到的点到原点的距离d、点与原点的连线l和zOy平面的夹角θ1,电机输出l与x轴的夹角θ2;
(3)使用(2)中扫描到的点到原点的距离d、l与zOy平面的夹角θ1和l与x轴的夹角θ2,解算激光雷达点云中每一个点在激光雷达坐标系中的坐标,输出带有坐标信息的点云Vn;
(4)使用双边滤波算法对点云Vn进行滤波处理,输出滤波后的点云Cn;
(5)用激光雷达测距算法对滤波后的点云Cn进行处理,即计算两次连续扫描之间激光雷达点云中每一个特征点的位移,按如下步骤进行:
(5.1)令α是点云Cn中的点,Μ是点云Cn中所有点的集合,定义变量h作为α的局部平滑度:
(5.2)对点云Cn中每一点的h值进行排序,将h值最大的选为边缘特征点,h值最小的选为平面特征点;
(5.4a)将(5.2)的边缘特征点的集合设为An,令b是An上的点,在点云中找到点b的最邻近点设为j,在点云Cn中找到点b的最邻近点设为v,用j和v确定一条边缘线(j,v),计算b点到边缘线(j,v)的对应距离,即边缘特征点的位移量dA:
令边缘线(j,v)的中点是点e,雷达坐标系的原点设为点o,将线段bo的长度设为lbo,线段eo的长度设为leo,线段be的长度设为lbe,通过余弦定理计算出bo与eo的夹角,即边缘特征点旋转角度
(5.4b)将(5.2)的平面特征点的集合设为Bn,令r为Bn上的点,在点云中找到点r的最邻近点设为η,在点云Cn中找到r的两个最邻近点设为u和m,用η、u和m确定平面块(η,u,m),计算r点到平面块(η,u,m)的对应距离,即平面特征点的位移量dB:
令平面块(η,u,m)的中心是点g,将线段go的长度设为lgo,线段ro的长度设为lro,线段gr的长度设为lgr,通过余弦定理计算出go与ro的夹角,即平面特征点的旋转角度
(6)令开始扫描时激光雷达所在的位置为世界坐标系的原点,利用激光雷达绘图算法将Cn配准到世界坐标系上,构成三维点云图。
2.根据权利要求1所述的方法,其中步骤(4)中使用双边滤波算法对点云Vn进行滤波处理,按如下步骤进行:
(4.1)建立k-邻域:
令点云Vn中所有点的集合为:Cloud2={p1,p2,…pi…,pn},其中pi为点云Vn中第i个点,i∈(1,n),n为点云Vn中所有点的个数;
假设有一点p∈Cloud2,将与p点最邻近的k个点设为p的k-邻域k(p);
(4.2)使用最小二乘法在k-邻域k(p)内构造一个平面,称为点p在k(p)上的切平面S(p);
(4.4)将点云Vn中每一个点的坐标通过下式进行滤波:
3.根据权利要求1所述的方法,其中步骤(6)中利用激光雷达绘图算法将Cn配准到世界坐标系上,按如下步骤进行:
(6.1)令第n-1次扫描之前世界坐标系中的点云为Dn-1,将点云Cn转换到世界坐标系中,用Dn表示;
(6.4)合并(6.2)和(6.3)中输出的点云Kn和点云Jn,构成三维点云图。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710598881.5A CN107462897B (zh) | 2017-07-21 | 2017-07-21 | 基于激光雷达的三维建图的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710598881.5A CN107462897B (zh) | 2017-07-21 | 2017-07-21 | 基于激光雷达的三维建图的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107462897A CN107462897A (zh) | 2017-12-12 |
CN107462897B true CN107462897B (zh) | 2020-01-07 |
Family
ID=60546922
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710598881.5A Active CN107462897B (zh) | 2017-07-21 | 2017-07-21 | 基于激光雷达的三维建图的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107462897B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109974742A (zh) * | 2017-12-28 | 2019-07-05 | 沈阳新松机器人自动化股份有限公司 | 一种激光里程计算方法和地图构建方法 |
CN109001752A (zh) * | 2018-05-18 | 2018-12-14 | 威海晶合数字矿山技术有限公司 | 一种三维测量建模系统及其方法 |
CN110515089B (zh) * | 2018-05-21 | 2023-06-02 | 华创车电技术中心股份有限公司 | 基于光学雷达的行车辅助方法 |
CN109903330B (zh) * | 2018-09-30 | 2021-06-01 | 华为技术有限公司 | 一种处理数据的方法和装置 |
CN111259807B (zh) * | 2020-01-17 | 2023-09-01 | 中国矿业大学 | 井下有限区域移动设备定位系统 |
CN111830532A (zh) * | 2020-07-22 | 2020-10-27 | 厦门市和奕华光电科技有限公司 | 一种多模块复用激光雷达及扫地机器人 |
CN113504543B (zh) * | 2021-06-16 | 2022-11-01 | 国网山西省电力公司电力科学研究院 | 无人机LiDAR系统定位定姿系统及方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102629367B (zh) * | 2012-01-17 | 2014-11-26 | 安徽建筑工业学院 | 基于KDTree的点云数据双边滤波去噪的方法 |
CN105023287B (zh) * | 2015-07-08 | 2018-04-17 | 西安电子科技大学 | 一种用于动态三维场景的激光雷达成像与着色方法 |
CN105205858B (zh) * | 2015-09-18 | 2018-04-13 | 天津理工大学 | 一种基于单个深度视觉传感器的室内场景三维重建方法 |
CN105719249B (zh) * | 2016-01-15 | 2018-05-08 | 吉林大学 | 一种基于三维格网的机载激光雷达点云去噪方法 |
CN105787997B (zh) * | 2016-03-27 | 2018-12-25 | 中国海洋大学 | 水下高精度三维重建装置及方法 |
-
2017
- 2017-07-21 CN CN201710598881.5A patent/CN107462897B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN107462897A (zh) | 2017-12-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107462897B (zh) | 基于激光雷达的三维建图的方法 | |
CN110189399B (zh) | 一种室内三维布局重建的方法及系统 | |
US7747106B2 (en) | Method and system for filtering, registering, and matching 2.5D normal maps | |
CN113139453A (zh) | 一种基于深度学习的正射影像高层建筑基底矢量提取方法 | |
CN205451195U (zh) | 一种基于多摄像机的实时三维点云重建系统 | |
CN115421158A (zh) | 自监督学习的固态激光雷达三维语义建图方法与装置 | |
CN113686314A (zh) | 船载摄像头的单目水面目标分割及单目测距方法 | |
Rothermel et al. | Fast and robust generation of semantic urban terrain models from UAV video streams | |
CN113393524A (zh) | 一种结合深度学习和轮廓点云重建的目标位姿估计方法 | |
CN112945233A (zh) | 一种全局无漂移的自主机器人同时定位与地图构建方法 | |
CN113409242A (zh) | 一种轨交弓网点云智能监测方法 | |
Poglitsch et al. | [POSTER] A Particle Filter Approach to Outdoor Localization Using Image-Based Rendering | |
CN116958434A (zh) | 多视图三维重建方法、测量方法及系统 | |
CN115830116A (zh) | 一种鲁棒视觉里程计方法 | |
Hirata et al. | Real-time dense depth estimation using semantically-guided LIDAR data propagation and motion stereo | |
Cabezas et al. | Aerial reconstructions via probabilistic data fusion | |
Sun et al. | Window detection employing a global regularity level set from oblique unmanned aerial vehicle images and point clouds | |
Li et al. | Mobile robot map building based on laser ranging and kinect | |
CN114648561A (zh) | 旋转式三维激光雷达的点云匹配方法及系统 | |
Goron et al. | 3D laser scanning system and 3D segmentation of urban scenes | |
CN114004900A (zh) | 一种基于点线面特征的室内双目视觉里程计方法 | |
Meixner et al. | Interpreting building facades from vertical aerial images using the third dimension | |
Kang et al. | 3D urban reconstruction from wide area aerial surveillance video | |
Cai et al. | A target tracking and location robot system based on omnistereo vision | |
Tao et al. | An efficient 3D object detection method based on Fast Guided Anchor Stereo RCNN |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |