CN116299527A - 一种基于激光里程计的室内高精度自定位方法 - Google Patents
一种基于激光里程计的室内高精度自定位方法 Download PDFInfo
- Publication number
- CN116299527A CN116299527A CN202310361409.5A CN202310361409A CN116299527A CN 116299527 A CN116299527 A CN 116299527A CN 202310361409 A CN202310361409 A CN 202310361409A CN 116299527 A CN116299527 A CN 116299527A
- Authority
- CN
- China
- Prior art keywords
- laser radar
- coordinate system
- point
- laser
- ref
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 34
- 239000003550 marker Substances 0.000 claims abstract description 25
- 238000001914 filtration Methods 0.000 claims abstract description 4
- 238000004364 calculation method Methods 0.000 claims description 9
- 238000006243 chemical reaction Methods 0.000 claims description 9
- 239000000463 material Substances 0.000 claims description 9
- 230000008569 process Effects 0.000 claims description 8
- 238000012935 Averaging Methods 0.000 claims description 5
- 239000011159 matrix material Substances 0.000 claims description 5
- 238000004220 aggregation Methods 0.000 claims description 3
- 238000012545 processing Methods 0.000 claims description 3
- 238000012216 screening Methods 0.000 abstract description 2
- 230000002159 abnormal effect Effects 0.000 abstract 1
- 230000007613 environmental effect Effects 0.000 abstract 1
- 238000013507 mapping Methods 0.000 description 8
- 238000002310 reflectometry Methods 0.000 description 8
- 238000001514 detection method Methods 0.000 description 7
- 238000005259 measurement Methods 0.000 description 7
- 238000005516 engineering process Methods 0.000 description 6
- 238000010168 coupling process Methods 0.000 description 5
- 238000005457 optimization Methods 0.000 description 4
- 230000005540 biological transmission Effects 0.000 description 3
- 238000000605 extraction Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000004807 localization Effects 0.000 description 2
- 239000002245 particle Substances 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 238000007500 overflow downdraw method Methods 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 238000002604 ultrasonography Methods 0.000 description 1
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/86—Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A90/00—Technologies having an indirect contribution to adaptation to climate change
- Y02A90/10—Information and communication technologies [ICT] supporting adaptation to climate change, e.g. for weather forecasting or climate simulation
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- General Physics & Mathematics (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
本发明公开了一种基于激光里程计的室内高精度自定位方法,包含机械旋转式三维多线激光雷达移动平台、便携式计算设备和多个反射标记物。首先,将激光雷达设备固定安装在可移动平台上,在室内场景中布置多个形状不同的反射标记物以实现远距离定位;然后,启动激光雷达,通过便携式计算设备获取环境点云数据,筛选出反射强度值较大的点集,并利用聚类算法区分不同形状的反射标记,滤去异常值;通过激光雷达所处坐标系和世界坐标系的角度关系,解算得到在单个反射标记物下的激光雷达位置;最后,将反射标记物参考点云的距离值之和作归一化处理,通过计算各反射标记物参考点的距离值权重来估计激光雷达的最终位置。
Description
技术领域
本发明涉及激光雷达(Light Detection and Ranging,LiDAR)室内自定位领域,具体是利用激光雷达对不同反射率材料具有不同反射强度测量值的特性,通过在参考位置引入特制形状的高反射率标记物,然后基于激光雷达测得的点云数据筛选出反射标记物参考点,通过参考点的角度和距离信息解算出激光雷达的位置坐标,在大幅度降低传统激光同步定位和绘图技术(Simultaneous Localization and Mapping,SLAM)里程计(LiDAROdometry,LO)算法时间复杂度的同时能够提升定位精度。
背景技术
近年来,随着机器人与传感器技术的飞速发展,室内移动机器人在机器人领域的地位举足轻重,室内定位技术研究也因此显得尤为重要。室内定位作为新一代物联网(Internet of Things,IoT)的核心技术,市场需求巨大。由于室内空间拓扑及布局复杂易变,同时存在复杂电磁环境影响有效信号的传输,导致信号传播出现多径及非视距误差等问题。这些因素导致卫星定位导航等室外定位技术在室内环境中应用时,精度会大幅度下降。室内定位系统经过几十年的发展和完善,其相关技术包含WI-FI、蓝牙、超声波、射频识别(Radio Frequency Identification,RFID)和超宽带信号(Ultra-wideband,UWB)等。然而,这些基于无线信号的定位技术因信号多径传播对无线电信号造成的影响,在复杂室内环境下的定位精度难以保证。激光雷达具有分辨率高、抗干扰性强、不受光线影响等优点,基于激光雷达的室内定位技术逐渐成为热门研究领域。
利用激光点云解决SLAM中三维场景的定位和地图构建问题,最早可追溯到LOAM(LiDAR Odometry and Mapping)算法,该算法以新颖的方法提取激光点云线面特征减少计算量,并开创性地将运动估计问题分成两个独立算法来共同完成,一个算法执行高频率的里程计返回低精度的运动估计,另一个算法运行频率较低的匹配建图但返回高精确的运动估计,最终将两个数据融合成高频率高精度的运动估计,很好地权衡了精度和效率,实时性高,唯一的不足点在于缺少回环检测,这将给建图和位置估计带来较大的累计漂移误差。LeGO-LOAM(Lightweight and Ground-Optimized LiDAR Odometry and Mapping)在LOAM的基础上衍生出新的框架,在特征提取上提升轻量化和地面优化,并增加了回环检测,整个框架与目前成熟的图优化3D激光雷达SLAM方案框架吻合,构建的地图更加完善。而基于VelodyneHDL-32E激光雷达提出的图优化(graph-based)SLAM方案HDL_Gragh_SLAM,其通过在后端优化过程中融合全球定位系统(Global Position System,GPS)、惯性测量单元(Inertial Measurement Unit,IMU)和路面约束信息,可以更好地构建全局一致性地图。然而,增加传感器和回环检测会给系统带来较大的计算开销且回环检测存在感知偏差和感知变异,需要在准确率和召回率之间作权衡处理,影响了SLAM的实时性。
除了建图,这些SLAM算法在全局位姿估计方面提出了基于点云配准算法获取当前帧的激光里程计。但是点云的稀疏性和运动干扰会使得激光里程计的精度急剧下降。通过融合IMU的状态估计数据可提升激光里程计的精度。其主要分为两类方法,一类是松耦合方法,该方法分别计算激光雷达和IMU的状态估计数据,以舍弃大量不相关数据信息为代价来换取较小的计算负载。另一类是紧耦合方法,通过IMU测量提供状态预测,同时测量更新被用于修正预测的状态,领域内也称之为激光惯性里程计(LiDAR Inertial Odometry,LIO)。LIO_mapping(LiDAR Inertial Odometry and Mapping)首次提出了紧耦合的LiDAR-IMU融合方法,通过联合优化IMU和LiDAR的测量数据校正漂移误差,相较于松耦合方法,紧耦合方法会使精度大幅提升。作为LeGO-LOAM的更新,LIO-SAM在图优化框架的基础上实现了紧耦合激光——惯性里程计。这类基于点云配准的里程计算法依赖于激光点云的特征提取以及运动状态估计,具有较高的时间复杂度,且里程计仅包含运动先验信息,容易造成位姿估计不准确。
先前的工作主要集中在如何处理纯几何信息以校正点云误差,忽略了强度信息。事实上,强度信息与材料的反射率有关,对于不同类别物体材料反射率的区别尤其明显,这对于定位和物体识别很有价值。如果在SLAM系统中引入反射标记物,可以利用激光雷达对于高反射率材料易辨别的特性,通过固定反射标记物的位置,根据测得的角度和距离信息来解算激光雷达位置坐标,从而实现激光雷达的自主定位。
本方法仅通过激光雷达获取三维场景反射参考点的角度和距离信息完成位置解算,并未引入类似于里程计等利用先验信息进行后验估计的算法,能够校正运动过程中由帧间估计导致的累计漂移误差,从而代替计算复杂度高和检测效率低的回环检测,有望实现在室内场景下的高精度定位。然而,在实际情况下,反射标记物激光点云并非理想质点模型,而是由散点集合表示,这就要求必须考虑激光雷达角度分辨率以及反射标记物的形状大小来筛选参考点,避免由于参考点选择不当导致的定位误差。
发明内容
本发明的目的在于提供一种基于激光里程计的室内高精度自定位方法。与传统激光里程计方法相比,本发明利用激光雷达对于高反射率材料具有较高反射强度值的特性,通过在参考位置引入反射标记物,进而根据标记物的角度和距离信息解算激光雷达的位置;同时考虑到在实际应用中反射标记物并非理想质点模型,需要根据激光雷达角度分辨率以及反射标记物的形状大小来选取参考点。由于受到激光雷达测量距离限制以及运动畸变干扰,仅靠单个反射标记物难以完成复杂环境下的远距离室内高精度定位,该方法引入了N个形状不同的反射标记物以完成远距离定位,可在实现校正里程计累计漂移误差的同时大幅度降低传统激光里程计的算法时间复杂度。
本发明所采用的技术方案为:一种基于激光里程计的室内高精度自定位方法,包含机械旋转式三维多线激光雷达移动平台、便携式计算设备和N个参考反射标记物。将激光雷达设备固定于移动平台上,将激光雷达作为原点的坐标系称为激光雷达坐标系,其对应每一帧点云所构成的局部地图,而以激光雷达初始位置为原点的坐标系世界称为世界坐标系,对应所有点云构成的全局地图。在室内环境中参考位置放置特制形状的反射标记物Ri(1≤i≤N),其由高反射率的反光材料构成,特征为具有较高的反射强度值,记录Ri在世界坐标系下的坐标值其特征在于包括以下步骤:
步骤一、启动激光雷达,通过相连接的便携式计算设备获取点云数据并存储到集合同时取出/>的反射强度值I归一化后存放在集合/>排除同一物体因为距离变化导致强度值I不同的影响,以便后续用于反射标记物Ri的特征提取,其表示为:
步骤四、从子集合Cu中取出反射强度值最大的点及其距离和方位角等原始数据,存放在Ti中,分别对集合Cu构成直线和集合Cu构成平面这两种情况进行处理;
步骤五、若Ti集合中仅包含单条线束上的点云,则对index取均值即可得到中心点的位置IDi,若Ti集合中包含多条线束点云,则对ID号求平均值取整后得到单条线束索引值IDmid,再将IDmid中的点云ID号求平均值得到IDi,最后将计算得到的IDi保存到ref集合(即反射标记物Ri对应的参考点云集合);
步骤六、记录激光雷达坐标系绕世界坐标系z轴旋转的角度根据参考点ref的索引号index可在点云集合/>中得到激光雷达坐标系下入射激光束与xoy平面形成的入射角α、参考点ref在xoy平面的投影与y轴形成的夹角γ以及激光雷达到ref的距离值d;
步骤八、假设激光雷达在世界坐标系下的坐标值为(xL,yL,zL),根据激光雷达坐标系和世界坐标系的转换关系,可将参考点ref从激光雷达坐标系转换到世界坐标系,其转换关系表示为:
步骤九、根据上述转换关系,可求得在每一帧点云中激光雷达在世界坐标系下的坐标值(xL,yL,zL)为:
步骤十、可进一步将其转化为矩阵的形式:
步骤十一、上述步骤得到了基于某个反射标记物Ri的激光雷达位置坐标,进一步对步骤三的M个子集合Cu重复步骤四至十,可得到分别由M个反射标记物计算出的激光雷达位置坐标(xL,yL,zL);
步骤十二、根据步骤五中每个子集Cu对应的ref,归一化其距离值d之和,计算各参考点的距离值权重来估计激光雷达的位置(x′L,y′L,z′L),其表达式为:
附图说明
图1为本发明激光雷达平台在室内场景布局图;
图2为本发明室内场景反射强度值图(含反射标记物);
图3为本发明激光雷达坐标系与世界坐标系转换关系图;
图4为本发明与两种SLAM算法里程计的激光雷达自定位误差图。
具体实施方案
下面结合附图对本发明作进一步详细描述。
本发明所采用的技术方案为一种基于激光里程计的室内高精度自定位方法,包含机械旋转式三维多线激光雷达移动平台、便携式计算设备和N个参考反射标记物。将激光雷达设备固定于移动平台上,将激光雷达作为原点的坐标系称为激光雷达坐标系,其对应每一帧点云所构成的局部地图,而以激光雷达初始位置为原点的坐标系世界称为世界坐标系,对应所有点云构成的全局地图。其特征在于包括以下步骤:
步骤一、如图1所示,将激光雷达设备固定安装于移动平台放置在起点位置,在室内走廊环境中选择并固定反射标记物R,其可由高反射率的反光材料构成,特征为具有较高的反射强度值,记录R在世界坐标系下的坐标值(xR,yR,zR);
步骤三、由于处于室内环境,大气传输系数和系统传输系数可以认为是常量,而距离值的差距引起的I变化并不明显,因此,反射强度值I受物体材料反射率影响较大,可通过比较反射强度值集合筛选估计出反射标记物的参考点ref,反射标记物与室内环境其他物体的反射强度值可见图2;
步骤五、如图3所示,根据激光雷达坐标系绕世界坐标系z轴旋转的角度激光雷达坐标系下的垂直角α和水平旋转角γ以及距离值d计算出参考点ref在激光雷达坐标系下的坐标值(x′R,y′R,z′R),其关系满足:
步骤六、假设激光雷达在世界坐标系下的坐标值为(xL,yL,zL),激光雷达坐标系和世界坐标系的转换关系见图3,可将参考点ref从激光雷达坐标系转换到世界坐标系,其转换关系表示为:
步骤七、根据上述转换关系,可求得在每一帧点云中激光雷达在世界坐标系下的坐标值(xL,yL,zL)为:
其中,(x′R,y′R,z′R)为参考点在激光雷达坐标系下的坐标,其等价关系为:
步骤八、可进一步将其转化为矩阵的形式:
步骤九、对点云集合中所有数据帧进行上述步骤计算则可得到SLAM过程中激光雷达的运动轨迹,完成室内高精度定位,图4为实验中LOAM和LeGO-LOAM两种SLAM算法里程计与本发明方法的激光雷达自主定位误差对比图;
步骤十、上述步骤得到了基于某个反射标记物R的激光雷达位置坐标,进而引入N个反射标记物,重新进行上述步骤;
进而得到分别由M个反射标记物计算出的激光雷达位置坐标(xL,yL,zL);
步骤十二、由步骤三得到反射标记物点云集合Cu对应的ref,归一化其距离值d之和,计算各反射标记物参考点的距离值权重来估计激光雷达的位置坐标(x′L,y′L,z′L),表达式为:
最终可得到激光雷达的运动轨迹,实现室内高精度自定位。
所述步骤三包括以下步骤:
其中,k为孤立点在第i帧点云Ii中的索引值;
步骤三(三)、Ti中的点存在两类情形,一种是与相邻的点构成直线,另一种是与相邻的点形成平面,这取决于选取的单个反射标记物的大小和激光雷达的角度分辨率,激光雷达是以固定方向(顺时针或逆时针)进行扫描,若Ti集合中的点是第一种情况,直接对index取均值即可得到中心点的位置IDi,其关系满足:
步骤三(四)、若Ti集合中的点属于第二种情况,则需要将多条线束的ID号求平均值取整后得到IDmid,满足:
步骤三(五)、进一步将IDmid中的点带入步骤五(三)中替换Ti进行计算;
步骤三(六)、最后将计算得到的IDi存到ref集合中,表达式为:
Claims (1)
1.一种基于激光里程计的室内高精度自定位方法,包含机械旋转式三维多线激光雷达移动平台、便携式计算设备和N个参考反射标记物。将激光雷达设备固定于移动平台上,将激光雷达作为原点的坐标系称为激光雷达坐标系,其对应每一帧点云所构成的局部地图,而以激光雷达初始位置为原点的坐标系世界称为世界坐标系,对应所有点云构成的全局地图。在室内环境中参考位置放置特制形状的反射标记物Ri(1≤i≤N),其由高反射率的反光材料构成,特征为具有较高的反射强度值,记录Ri在世界坐标系下的坐标值其特征在于包括以下步骤:
步骤一、启动激光雷达,通过相连接的便携式计算设备获取点云数据并存储到集合同时取出/>的反射强度值I归一化后存放在集合/>排除同一物体因为距离变化导致强度值I不同的影响,以便后续用于反射标记物Ri的特征提取,其表示为:
步骤四、从子集合Cu中取出反射强度值最大的点及其距离和方位角等原始数据,存放在Ti中,分别对集合Cu构成直线和集合Cu构成平面这两种情况进行处理;
步骤五、若Ti集合中仅包含单条线束上的点云,则对index取均值即可得到中心点的位置IDi,若Ti集合中包含多条线束点云,则对ID号求平均值取整后得到单条线束索引值IDmid,再将IDmid中的点云ID号求平均值得到IDi,最后将计算得到的IDi保存到ref集合(即反射标记物Ri对应的参考点云集合);
步骤六、记录激光雷达坐标系绕世界坐标系z轴旋转的角度根据参考点ref的索引号index可在点云集合/>中得到激光雷达坐标系下入射激光束与xoy平面形成的入射角α、参考点ref在xoy平面的投影与y轴形成的夹角γ以及激光雷达到ref的距离值d;
步骤八、假设激光雷达在世界坐标系下的坐标值为(xL,yL,zL),根据激光雷达坐标系和世界坐标系的转换关系,可将参考点ref从激光雷达坐标系转换到世界坐标系,其转换关系表示为:
步骤九、根据上述转换关系,可求得在每一帧点云中激光雷达在世界坐标系下的坐标值(xL,yL,zL)为:
步骤十、可进一步将其转化为矩阵的形式:
步骤十一、上述步骤得到了基于某个反射标记物Ri的激光雷达位置坐标,进一步对步骤三的M个子集合Cu重复步骤四至十,可得到分别由M个反射标记物计算出的激光雷达位置坐标(xL,yL,zL);
步骤十二、根据步骤五中每个子集Cu对应的ref,归一化其距离值d之和,计算各参考点的距离值权重来估计激光雷达的位置(x′L,y′L,z′L),其表达式为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310361409.5A CN116299527A (zh) | 2023-04-06 | 2023-04-06 | 一种基于激光里程计的室内高精度自定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310361409.5A CN116299527A (zh) | 2023-04-06 | 2023-04-06 | 一种基于激光里程计的室内高精度自定位方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN116299527A true CN116299527A (zh) | 2023-06-23 |
Family
ID=86779842
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310361409.5A Pending CN116299527A (zh) | 2023-04-06 | 2023-04-06 | 一种基于激光里程计的室内高精度自定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116299527A (zh) |
-
2023
- 2023-04-06 CN CN202310361409.5A patent/CN116299527A/zh active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108921947B (zh) | 生成电子地图的方法、装置、设备、存储介质以及采集实体 | |
CN109598765B (zh) | 基于球形标定物的单目相机与毫米波雷达外参联合标定方法 | |
KR102110813B1 (ko) | 무선 환경 변화에 강인한 slam 방법 및 장치 | |
CN103995250B (zh) | 射频标签轨迹追踪方法 | |
CN114659514B (zh) | 一种基于体素化精配准的LiDAR-IMU-GNSS融合定位方法 | |
CN110187375A (zh) | 一种基于slam定位结果提高定位精度的方法及装置 | |
CN110542908A (zh) | 应用于智能驾驶车辆上的激光雷达动态物体感知方法 | |
CN115407357B (zh) | 基于大场景的低线束激光雷达-imu-rtk定位建图算法 | |
CN105203023A (zh) | 一种车载三维激光扫描系统安置参数的一站式标定方法 | |
CN114526745A (zh) | 一种紧耦合激光雷达和惯性里程计的建图方法及系统 | |
CN112904358B (zh) | 基于几何信息的激光定位方法 | |
CN112446844B (zh) | 一种基于点云特征提取与配准融合方法 | |
CN113419235A (zh) | 一种基于毫米波雷达的无人机定位方法 | |
CN112505671A (zh) | Gnss信号缺失环境下毫米波雷达目标定位方法及装置 | |
Yu et al. | Automatic extrinsic self-calibration of mobile LiDAR systems based on planar and spherical features | |
CN115728803A (zh) | 一种城市驾驶车辆连续定位系统及方法 | |
CN115639570A (zh) | 融合激光强度和点云几何特征的机器人定位和建图方法 | |
Lu et al. | A lightweight real-time 3D LiDAR SLAM for autonomous vehicles in large-scale urban environment | |
CN114063127A (zh) | 一种多焦距视觉slam与gps融合的方法及存储介质 | |
CN113375661A (zh) | 一种无人驾驶系统的定位导航方法及系统 | |
CN117109581A (zh) | 移动机器人自定位导航方法、系统、电子设备及存储介质 | |
CN116299527A (zh) | 一种基于激光里程计的室内高精度自定位方法 | |
CN116679314A (zh) | 融合点云强度的三维激光雷达同步建图与定位方法及系统 | |
CN115951369A (zh) | 面向复杂港口环境的多传感器融合定位方法 | |
CN113066161B (zh) | 一种城市电波传播模型的建模方法 |
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 |