CN113777593B - 基于伺服电机辅助运动的多激光雷达外参标定方法和装置 - Google Patents
基于伺服电机辅助运动的多激光雷达外参标定方法和装置 Download PDFInfo
- Publication number
- CN113777593B CN113777593B CN202111330346.4A CN202111330346A CN113777593B CN 113777593 B CN113777593 B CN 113777593B CN 202111330346 A CN202111330346 A CN 202111330346A CN 113777593 B CN113777593 B CN 113777593B
- Authority
- CN
- China
- Prior art keywords
- laser
- coordinate system
- radar
- laser radar
- point
- 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
- 238000000034 method Methods 0.000 title claims abstract description 81
- 230000033001 locomotion Effects 0.000 title claims abstract description 52
- 238000005457 optimization Methods 0.000 claims description 34
- 238000012545 processing Methods 0.000 claims description 18
- 239000011159 matrix material Substances 0.000 claims description 12
- 238000004590 computer program Methods 0.000 claims description 11
- 230000009466 transformation Effects 0.000 claims description 11
- 238000006243 chemical reaction Methods 0.000 claims description 4
- 238000004364 calculation method Methods 0.000 abstract description 7
- 230000006870 function Effects 0.000 description 5
- 239000003550 marker Substances 0.000 description 5
- 238000004891 communication Methods 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 238000013519 translation Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000007613 environmental effect Effects 0.000 description 3
- 230000003287 optical effect Effects 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 241000287196 Asthenes Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000001131 transforming effect Effects 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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/497—Means for monitoring or calibrating
-
- 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/02—Systems using the reflection of electromagnetic waves other than radio waves
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Electromagnetism (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
本发明提供一种基于伺服电机辅助运动的多激光雷达外参标定方法和装置,其中,方法包括:构建与多激光雷达中每一个雷达对应的虚拟电机坐标系;根据所述每一个雷达与所述虚拟电机坐标系确定所述雷达与所述虚拟电机坐标系之间的外参;根据所述外参确定对应的所述雷达的环境模型;根据每一个所述雷达的环境模型确定所述多激光雷达之间的外参。本发明适用于具有任意相对位姿关系、任意多个激光雷达之间的外参标定,且不要求多激光雷达之间有共视区域。该标定方法操作简单便捷、扩展性强、计算高效、无需特定的标定物或场景布置,适合用于多激光雷达***的流程化、快速、精准标定。
Description
技术领域
本发明涉及定位技术领域,尤其涉及一种基于伺服电机辅助运动的多激光雷达外参标定方法和装置。
背景技术
激光雷达可以获取周围环境的结构信息与反射信息,可实现定位导航和三维重
建,被广泛应用在自动驾驶、数字孪生、AR、VR等领域。一个激光雷达的扫描范围通常是有限
的,如常用的Velodyne VLP-16激光雷达水平扫描范围是 360°,垂直扫描范围是。为
了能够使用激光雷达对环境进行完整的扫描和重建,需要在扫描过程中不断地变换激光雷
达相对于环境空间的位置和姿态(简称为位姿),来达到对周围环境的完整扫描。相比单激
光雷达,由多个激光雷达组成的扫描***可以显著扩大扫描范围、优化扫描模式、提高扫描
效率。为了联合使用多个激光雷达的扫描数据,需要将每次扫描得到的激光点云表达在统
一的空间坐标系下,这就需要提前求解不同激光雷达之间的相对位姿,即多个激光雷达之
间的相对位姿标定问题,又称多激光雷达的外参标定问题。
若不同的激光雷达在静态扫描情况下得到的点云有较大的重叠,可以采用迭代最近点(Iterative Closest Point, ICP)方法来求得两个扫描点云之间的相对位姿,从而实现激光雷达之间的外参估计。此时多激光雷达外参标定问题可以建模为一个点云匹配问题。该方法估计一个相对位姿,将一个点云进行刚体变换,以使其与目标点云尽可能地重合。这类方法适用于不同激光雷达的扫描视野之间有较大重合的情况,且要求被扫描的环境需要有一定的空间复杂度,也即足够的结构特征,如不平行的平面与边缘等,来提供足够的相对位姿约束。然而使用多个激光雷达的目的通常是扩展扫描视野,这种情况下多个激光雷之间的共视区域非常小甚至完全没有共视区域,因此迭代最近点方法不适用于共视区域非常小的多激光雷达外参标定问题。
另一种常用的传感器标定方法是基于人工标定板(artificial chessboard)、人造标志物(factitious marker)和特定环境结构(specific environment structure)等标志物的标定方法。使用这类方法进行多个激光雷达的外参标定时,需要多个激光雷达能够同时观测到标志物,并且能够从激光雷达数据中提取出标志物的匹配特征信息。由于标志物是事先制作或选定的,因此具有极强的先验信息来保证提取的对应信息的准确性,标定结果通常也非常可靠。然而该方法要求不同的激光雷达能够同时观测到标志物,这对于共视区域很小的多激光雷达***来说是不适用的。此外,基于标志物的方法通常需要采集多组数据以提供足够的约束信息,因此需要对标志物的位置姿态进行小心调整和多次布置,这使得标定过程非常繁琐和耗时。
针对多传感器之间共视区域小、不方便使用标志物情况,基于运动的方法(motion-based methods)被提出用于实现多激光雷达外参标定。此种方法使多激光雷达***在环境中任意运动一段时间同时采集数据,之后利用每个激光雷达采集的数据单独计算运动轨迹或重建周围环境的三维模型,然后把每个激光雷达的轨迹或重建模型进行对齐,从而求得不同激光雷达之间的相对位姿,即外参。基于运动的方法解决了共视区域的限制问题,但是其轨迹计算和模型重建依赖于其它算法,如里程计(odometry)估计,同步定位与建图(Simultaneous Localization and Mapping, SLAM)等。这些算法本身会引入误差,进而会影响标定结果的准确性。此外,为了约束外参的所有变量,通常需要扫描采集时的运动轨迹、周围环境的复杂度达到一定的要求,在有些情况下这是不容易满足的。
发明内容
本发明提供一种基于伺服电机辅助运动的多激光雷达外参标定方法和装置,用以解决现有技术中多激光雷达外参标定不准确的缺陷,实现准确、快捷标定多激光雷达外参。
第一方面,本发明提供一种基于伺服电机辅助运动的多激光雷达外参标定方法,包括:
构建与多激光雷达中每一个雷达对应的虚拟电机坐标系;
根据所述每一个雷达与所述虚拟电机坐标系确定所述雷达与所述虚拟电机坐标系之间的外参;
根据所述外参确定对应的所述雷达的环境模型;
根据每一个所述雷达的环境模型确定所述多激光雷达之间的外参。
进一步,根据本发明提供的一种基于伺服电机辅助运动的多激光雷达外参标定方法,其中,所述构建与多激光雷达中每一个雷达对应的虚拟电机坐标系,具体包括:
获取所述每一个雷达的传感器坐标系;
将所述雷达的传感器坐标系经过最少量转动和最少量的平移后,使得所述雷达的传感器坐标系的任意一个坐标轴与伺服电机转动轴在空间中达到重合,得到转换后的雷达的传感器坐标系;
将所述转换后的雷达的传感器坐标系作为所述雷达对应的虚拟电机坐标系。
进一步,根据本发明提供的一种基于伺服电机辅助运动的多激光雷达外参标定方法,其中,所述根据所述每一个雷达与所述虚拟电机坐标系确定所述雷达与所述虚拟电机坐标系之间的外参,具体包括:
获取所述每一个雷达的传感器坐标系与所述雷达对应的虚拟电机坐标系的位姿转换结果作为初始外参;
获取所述每一个激光雷达随所述伺服电机转动一周的点云数据中的激光点在所述雷达的传感器坐标系中的坐标和所述激光点对应的所述伺服电机的转角;
根据所述初始外参和所述伺服电机的转角将所述激光点在所述雷达的传感器坐标系中的坐标转换为所述激光点在所述虚拟电机坐标系中的坐标;
根据所述第一点云模型和所述第二点云模型对所述初始外参进行迭代优化,得到最终优化外参作为所述雷达与所述虚拟电机坐标系之间的外参。
进一步,根据本发明提供的一种基于伺服电机辅助运动的多激光雷达外参标定方法,其中,所述根据所述外参确定对应的所述雷达的环境模型,具体包括:
根据所述每一个激光雷达随所述伺服电机转动一周的点云数据中的激光点在所述雷达的传感器坐标系中的坐标、所述激光点对应的所述伺服电机的转角和所述雷达与所述虚拟电机坐标系之间的外参将所述点云数据中的激光点坐标转换为所述虚拟电机坐标系中的坐标;
根据转换为所述虚拟电机坐标系中的坐标的激光点形成的点云数据与所述雷达与所述虚拟电机坐标系之间的外参变换矩阵的逆矩阵将所述点云数据中的激光点坐标转换为在所述每一个激光雷达的传感器坐标系下的坐标,得到所述雷达的环境模型。
进一步,根据本发明提供的一种基于伺服电机辅助运动的多激光雷达外参标定方法,其中,所述根据每一个所述雷达的环境模型确定所述多激光雷达之间的外参,具体包括:
获取所述多激光雷达中的每一个雷达的环境模型;
对所述多激光雷达中的雷达进行编号1、2、3……N;
获取所述激光雷达的每个雷达的传感器坐标系;
根据所述传感器坐标系依次获取相邻编号的两个雷达的第一外参,其中,编号为N的雷达与标号为1的雷达构成相邻;
根据所述每一个雷达的环境模型和所述第一外参进行迭代优化,得到所述多激光雷达之间的外参。
进一步,根据本发明提供的一种基于伺服电机辅助运动的多激光雷达外参标定方法,其中,所述根据所述第一点云模型和所述第二点云模型对所述初始外参进行迭代优化,得到最终优化外参作为所述雷达与所述虚拟电机坐标系之间的外参,具体包括:
根据所述第一点云模型和所述第二点云模型进行KD-tree构建,得到第一多维树和第二多维树;
搜索所述第一点云模型中的每一个第一激光点在所述第二多维书中半径搜索距离小于所述定值的点构成一个点集,并根据所述点集拟合出一个第一平面;
确定所述每一个第一激光点到对应的所述第一平面的第一距离;
搜索所述第二点云模型中的每一个第二激光点在所述第一多维树中半径搜索距离小于所述定值的点构成一个点集,并根据所述点集拟合出一个第二平面;
确定所述每一个第二激光点到对应的所述第二平面的第二距离;
根据所述第一距离和所述第二距离和所述初始外参进行迭代优化,得到最终优化外参作为所述雷达与所述虚拟电机坐标系之间的外参。
进一步,根据本发明提供的一种基于伺服电机辅助运动的多激光雷达外参标定方法,其中,所述根据所述每一个雷达的环境模型和所述第一外参进行迭代优化,得到所述多激光雷达之间的外参,具体包括:
根据所述每一个雷达的环境模型确定对应的点云模型,并对所述点云模型进行KD-tree构建,得到1号多维树、2号多维树、3号多维树……N号多维树;
搜索所述相邻两个雷达中的编号较小的点云模型中的每个激光点在所述编号较大的点云模型所述对应的KD-tree中半径搜索距离小于定值的点构成一个点集,并根据所述点集拟合出一个第三平面,其中,编号为N的雷达与编号为1的雷达相邻时,编号为N的雷达作为编号较小的雷达;
确定所述编号较小的点云模型中的每一个点到对应的所述第三平面的第三距离;
根据所述第三距离和所述第一外参进行迭代优化,得到所述多激光雷达之间的外参。
第二方面,本发明提供一种基于伺服电机辅助运动的多激光雷达外参标定装置,包括:
第一处理模块,用于构建与多激光雷达中每一个雷达对应的虚拟电机坐标系;
第二处理模块,用于根据所述每一个雷达与所述虚拟电机坐标系确定所述雷达与所述虚拟电机坐标系之间的外参;
第三处理模块,用于根据所述外参确定对应的所述雷达的环境模型;
第四处理模块,用于根据每一个所述雷达的环境模型确定所述多激光雷达之间的外参。
第三方面,本发明还提供一种电子设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现如上述任一种所述基于伺服电机辅助运动的多激光雷达外参标定方法的步骤。
第四方面,本发明还提供一种非暂态计算机可读存储介质,其上存储有计算机程序,该计算机程序被处理器执行时实现如上述任一种所述基于伺服电机辅助运动的多激光雷达外参标定方法的步骤。
本发明提供的一种基于伺服电机辅助运动的多激光雷达外参标定方法和装置,首先构建与多激光雷达中每一个雷达对应的虚拟电机坐标系;根据所述每一个雷达与所述虚拟电机坐标系确定所述雷达与所述虚拟电机坐标系之间的外参;进而,再根据所述外参确定对应的所述雷达的环境模型;进一步,根据每一个所述雷达的环境模型确定所述多激光雷达之间的外参。本发明适用于具有任意相对位姿关系、任意多个激光雷达之间的外参标定,且不要求多激光雷达之间有共视区域。该标定方法操作简单便捷、扩展性强、计算高效、无需特定的标定物或场景布置,适合用于多激光雷达***的流程化、快速、精准标定。
附图说明
为了更清楚地说明本发明或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作一简单的介绍,显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本发明提供的基于伺服电机辅助运动的多激光雷达外参标定方法的流程示意图;
图2是本发明提供的构建与多激光雷达中每一个雷达对应的虚拟电机坐标系方法的流程示意图;
图3是本发明提供的确定所述雷达与所述虚拟电机坐标系之间的外参的流程示意图;
图4是本发明提供的根据每一个所述雷达的环境模型确定所述多激光雷达之间的外参的流程示意图;
图5是本发明提供的根据所述第一点云模型和所述第二点云模型对所述初始外参进行迭代优化,得到最终优化外参作为所述雷达与所述虚拟电机坐标系之间的外参的流程示意图;
图6是本发明提供的根据所述每一个雷达的环境模型和所述第一外参进行迭代优化,得到所述多激光雷达之间的外参的流程示意图;
图7是本发明提供的基于伺服电机辅助运动的多激光雷达外参标定装置的结构示意图;
图8是本发明提供的电子设备的结构示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将结合本发明中的附图,对本发明中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例,都属于本发明保护的范围。
下面结合图1描述本发明的一种基于伺服电机辅助运动的多激光雷达外参标定方法,包括:
步骤100:构建与多激光雷达中每一个雷达对应的虚拟电机坐标系;
具体地,在本发明中在确定多激光雷达的不同雷达之间的外参时,需要通过获取每一个雷达对应的虚拟电机坐标系,以虚拟电机坐标系为中介完成对激光雷达环境模型的构建。
步骤200:根据所述每一个雷达与所述虚拟电机坐标系确定所述雷达与所述虚拟电机坐标系之间的外参;
具体地,确定每一个雷达与构建的虚拟电机坐标系的外参,即确定所述雷达自身具有的传感器坐标系与构建的虚拟电机坐标系之间的外参,也即二者坐标系之间的位姿变换的值。
步骤300:根据所述外参确定对应的所述雷达的环境模型;
具体地,在已知激光雷达与虚拟电机坐标系的外参情况下,利用激光雷达跟随伺服电机转动一周所得的点云数据及伺服电机转角数据,即可将周围环境进行建模。
步骤400:根据每一个所述雷达的环境模型确定所述多激光雷达之间的外参。
具体地,利用多个激光雷达各自生成的环境模型之间的对齐关系构建约束条件求解多个激光雷达之间的外参数。
本发明提供的一种基于伺服电机辅助运动的多激光雷达外参标定方法,首先构建与多激光雷达中每一个雷达对应的虚拟电机坐标系;根据所述每一个雷达与所述虚拟电机坐标系确定所述雷达与所述虚拟电机坐标系之间的外参;进而,再根据所述外参确定对应的所述雷达的环境模型;进一步,根据每一个所述雷达的环境模型确定所述多激光雷达之间的外参。本发明适用于具有任意相对位姿关系、任意多个激光雷达之间的外参标定,且不要求多激光雷达之间有共视区域。该标定方法操作简单便捷、扩展性强、计算高效、无需特定的标定物或场景布置,适合用于多激光雷达***的流程化、快速、精准标定。
进一步,结合图2所示,根据本发明提供的一种基于伺服电机辅助运动的多激光雷达外参标定方法,其中,所述构建与多激光雷达中每一个雷达对应的虚拟电机坐标系,具体包括:
获取所述每一个雷达的传感器坐标系;
将所述雷达的传感器坐标系经过最少量转动和最少量的平移后,使得所述雷达的传感器坐标系的任意一个坐标轴与伺服电机转动轴在空间中达到重合,得到转换后的雷达的传感器坐标系;
将所述转换后的雷达的传感器坐标系作为所述雷达对应的虚拟电机坐标系。
具体地,虚拟电机坐标系是以伺服电机转动轴作为坐标系一条轴、另外两条轴与激光雷达坐标系相关的一个假想坐标系。虚拟电机坐标系是激光雷达坐标系经过一定的转动和平移后得到的。在某一时刻,或伺服电机转至某一特定角度θ时,将激光雷达坐标系经过最少量转动和最少量的平移后,使得激光雷达坐标系的某个轴与伺服电机转动轴在空间中达到重合,此时的激光雷达坐标系即为虚拟电机坐标系。
进一步,结合图3所示,根据本发明提供的一种基于伺服电机辅助运动的多激光雷达外参标定方法,其中,所述根据所述每一个雷达与所述虚拟电机坐标系确定所述雷达与所述虚拟电机坐标系之间的外参,具体包括:
获取所述每一个雷达的传感器坐标系与所述雷达对应的虚拟电机坐标系的位姿转换结果作为初始外参;
获取所述每一个激光雷达随所述伺服电机转动一周的点云数据中的激光点在所述雷达的传感器坐标系中的坐标和所述激光点对应的所述伺服电机的转角;
根据所述初始外参和所述伺服电机的转角将所述激光点在所述雷达的传感器坐标系中的坐标转换为所述激光点在所述虚拟电机坐标系中的坐标;
根据所述第一点云模型和所述第二点云模型对所述初始外参进行迭代优化,得到最终优化外参作为所述雷达与所述虚拟电机坐标系之间的外参。
具体地,记多激光雷达***中某一激光雷达坐标系为,与之对应的虚拟
电机坐标系为。记从激光雷达到虚拟电机坐标系的相对位姿变换为,
也即激光雷达与虚拟电机坐标系的外参,是该部分标定的目标。为后续计算简便直观,可取
伺服电机固定角度。
在已知激光雷达与虚拟电机坐标系的外参情况下,利用激光雷达跟随伺服电机转
动一周所得的点云数据及伺服电机转角数据,即可将周围环境进行建模。假设某一时刻伺
服电机转角为,激光雷达i采集到第j个激光点在坐标系下表示为,则在虚拟电机坐
标系下该激光点表示为:
进一步将该点变换到伺服电机转角为0时的虚拟电机坐标系,表示如下:
通过以上操作,即可将一段时间内采集到的激光点云组织成为环境模型。
由于激光雷达水平视场角度一般大于,雷达在随伺服电机转动完整一周的
过程中会在以及转角范围内形成对环境的两次重复扫描。然而,伺服电机转动
轴与激光雷达坐标系轴不重合直接导致了所形成的两个环境模型不是紧密吻合的,二者之
间可能存在一定的平移偏差和转动偏差。基于此,通过对两次重复扫描形成的环境模型进
行对齐,即可实现对激光雷达与虚拟电机坐标系的外参标定。
记某一激光雷达在伺服电机转角范围内形成的点云模型为,在伺服电
机转角范围内形成的点云模型为。通过寻找两个点云模型中平面点与平面的对
应关系构建约束,进而形成代价函数。进而,通过对所述代价函数的计算实现对所述雷达与
所述虚拟电机坐标系之间的外参的确定。
进一步,根据本发明提供的一种基于伺服电机辅助运动的多激光雷达外参标定方法,其中,所述根据所述外参确定对应的所述雷达的环境模型,具体包括:
根据所述每一个激光雷达随所述伺服电机转动一周的点云数据中的激光点在所述雷达的传感器坐标系中的坐标、所述激光点对应的所述伺服电机的转角和所述雷达与所述虚拟电机坐标系之间的外参将所述点云数据中的激光点坐标转换为所述虚拟电机坐标系中的坐标;
根据转换为所述虚拟电机坐标系中的坐标的激光点形成的点云数据与所述雷达与所述虚拟电机坐标系之间的外参变换矩阵的逆矩阵将所述点云数据中的激光点坐标转换为在所述每一个激光雷达的传感器坐标系下的坐标,得到所述雷达的环境模型。
然后,利用当时时刻的伺服电机角度信息将激光点从转动角度为θ的虚拟电机坐标系变换到转动角度为0的虚拟电机坐标系中,变换如下:
最后,再将激光点从转动角度为0的虚拟电机坐标系变换到转动角度为0的激光雷达坐标系中,变换如下:
进一步,结合图4所示,根据本发明提供的一种基于伺服电机辅助运动的多激光雷达外参标定方法,其中,所述根据每一个所述雷达的环境模型确定所述多激光雷达之间的外参,具体包括:
获取所述多激光雷达中的每一个雷达的环境模型;
对所述多激光雷达中的雷达进行编号1、2、3……N;
获取所述激光雷达的每个雷达的传感器坐标系;
根据所述传感器坐标系依次获取相邻编号的两个雷达的第一外参,其中,编号为N的雷达与标号为1的雷达构成相邻;
根据所述每一个雷达的环境模型和所述第一外参进行迭代优化,得到所述多激光雷达之间的外参。
具体地,为了清晰说明计算过程,此处具体以三个激光雷达之间的外参标定过程
为例进行详述。在获得三个激光雷达各自的环境模型后,采用与激光雷达和虚拟电
机坐标系外参标定相似的方法,寻找点云之间平面点与平面之间的对应关系,并利用该对
应关系作为约束,迭代求解三个点云之间的相对位姿关系,也即三个激光雷达之间的外参,
记为。
进一步,结合图5所示,根据本发明提供的一种基于伺服电机辅助运动的多激光雷达外参标定方法,其中,所述根据所述第一点云模型和所述第二点云模型对所述初始外参进行迭代优化,得到最终优化外参作为所述雷达与所述虚拟电机坐标系之间的外参,具体包括:
根据所述第一点云模型和所述第二点云模型进行KD-tree构建,得到第一多维树和第二多维树;
搜索所述第一点云模型中的每一个第一激光点在所述第二多维树中半径搜索距离小于定值的点构成一个点集,并根据所述点集拟合出一个第一平面;
确定所述每一个第一激光点到对应的所述第一平面的第一距离;
搜索所述第二点云模型中的每一个第二激光点在所述第一多维树中半径搜索距离小于所述定值的点构成一个点集,并根据所述点集拟合出一个第二平面;
确定所述每一个第二激光点到对应的所述第二平面的第二距离;
根据所述第一距离和所述第二距离和所述初始外参进行迭代优化,得到最终优化外参作为所述雷达与所述虚拟电机坐标系之间的外参。
具体地,平面点与平面的对应关系查找方法具体如下:
在两个不紧密吻合的环境模型和基础上,分别构建KD-tree,记为和。对于中的每一个点,在中通过半径搜索距离小于R的点构成一个点集,
并使用RANSAC方法对该点集进行平面拟合,要求平面拟合内点到拟合平面的距离小于d,从
而得到平面方程参数。为了保证该评估点以及所选平面的准确性,平面拟合
之后利用以下判据对非平面情况进行剔除:平面拟合完成后,要求拟合内点数占所有参与
拟合的点数量的比例大于,其中,。
在确定两个环境模型之间平面点与平面之间的对应关系之后,即可构建约束关系和代价方程。在本方法中,采用点到平面之间的距离作为代价的量化表征,通过最小化该距离实现两个环境模型的对齐。
此时,激光雷达到虚拟电机坐标系的外参标定问题可以表述为一个最小化代价函数的优化问题,具体表达如下:
从给定的外参初值或上一步迭代结果开始,利用非线性优化工具对上述问题进行迭代优化,得到激光雷达与虚拟电机坐标系的外参。迭代优化结束的判定准则设计如下:
当旋转变化量、平移变化量分别小于设定阈值DR和DT,或迭代次数超过最大循环次数MAX-ITER时,即可判定优化完成。
进一步,结合图6所示,根据本发明提供的一种基于伺服电机辅助运动的多激光雷达外参标定方法,其中,所述根据所述每一个雷达的环境模型和所述第一外参进行迭代优化,得到所述多激光雷达之间的外参,具体包括:
根据所述每一个雷达的环境模型确定对应的点云模型,并对所述点云模型进行KD-tree构建,得到1号多维树、2号多维树、3号多维树……N号多维树;
搜索所述相邻两个雷达中的编号较小的点云模型中的每个激光点在所述编号较大的点云模型所述对应的KD-tree中半径搜索距离小于定值的点构成一个点集,并根据所述点集拟合出一个第三平面,其中,编号为N的雷达与编号为1的雷达相邻时,编号为N的雷达作为编号较小的雷达;
确定所述编号较小的点云模型中的每一个点到对应的所述第三平面的第三距离;
根据所述第三距离和所述第一外参进行迭代优化,得到所述多激光雷达之间的外参。
具体地,同样以三个激光雷达为例进行说明。首先,对三个点云模型分别构建KD-
tree,并记为。对于中的每一个点,根据当前标定结果查找其位于中
的平面,确定平面参数;同样方法确定中每个点在中对应的平
面、中每个点在中对应的平面。
然后,计算每一个点到其对应平面的距离,用作代价函数的最小化优化目标。距离计算如下:
同时利用三个激光雷达外参的回环关系,构建代价函数如下:
从给定的外参初值开始,对上述问题进行迭代优化,即可得到三个激光雷达之间的外参。迭代优化结束的判定准则设计如下:
设相邻两次迭代优化的外参结果分别为:
当旋转变化量、平移变化量分别小于设定阈值DR和DT,或迭代次数超过最大循环次数MAX-ITER时,即可判定优化完成。
结合图7所示,本发明提供一种基于伺服电机辅助运动的多激光雷达外参标定装置,包括:
第一处理模块71,用于构建与多激光雷达中每一个雷达对应的虚拟电机坐标系;
第二处理模块72,用于根据所述每一个雷达与所述虚拟电机坐标系确定所述雷达与所述虚拟电机坐标系之间的外参;
第三处理模块73,用于根据所述外参确定对应的所述雷达的环境模型;
第四处理模块74,用于根据每一个所述雷达的环境模型确定所述多激光雷达之间的外参。
由于本发明实施例提供的装置,可以用于执行上述实施例所述的方法,其工作原理和有益效果类似,故此处不再详述,具体内容可参见上述实施例的介绍。
本发明提供的一种基于伺服电机辅助运动的多激光雷达外参标定装置,首先构建与多激光雷达中每一个雷达对应的虚拟电机坐标系;根据所述每一个雷达与所述虚拟电机坐标系确定所述雷达与所述虚拟电机坐标系之间的外参;进而,再根据所述外参确定对应的所述雷达的环境模型;进一步,根据每一个所述雷达的环境模型确定所述多激光雷达之间的外参。本发明适用于具有任意相对位姿关系、任意多个激光雷达之间的外参标定,且不要求多激光雷达之间有共视区域。该标定方法操作简单便捷、扩展性强、计算高效、无需特定的标定物或场景布置,适合用于多激光雷达***的流程化、快速、精准标定。
本发明提供的一种基于伺服电机辅助运动的多激光雷达外参标定装置,其中,第一处理模块71,具体用于:
获取所述每一个雷达的传感器坐标系;
将所述雷达的传感器坐标系经过最少量转动和最少量的平移后,使得所述雷达的传感器坐标系的任意一个坐标轴与伺服电机转动轴在空间中达到重合,得到转换后的雷达的传感器坐标系;
将所述转换后的雷达的传感器坐标系作为所述雷达对应的虚拟电机坐标系。
本发明提供的一种基于伺服电机辅助运动的多激光雷达外参标定装置,其中,第二处理模块72,具体用于:
获取所述每一个雷达的传感器坐标系与所述雷达对应的虚拟电机坐标系的位姿转换结果作为初始外参;
获取所述每一个激光雷达随所述伺服电机转动一周的点云数据中的激光点在所述雷达的传感器坐标系中的坐标和所述激光点对应的所述伺服电机的转角;
根据所述初始外参和所述伺服电机的转角将所述激光点在所述雷达的传感器坐标系中的坐标转换为所述激光点在所述虚拟电机坐标系中的坐标;
根据所述第一点云模型和所述第二点云模型对所述初始外参进行迭代优化,得到最终优化外参作为所述雷达与所述虚拟电机坐标系之间的外参。
本发明提供的一种基于伺服电机辅助运动的多激光雷达外参标定装置,其中,第三处理模块73,具体用于:
根据所述每一个激光雷达随所述伺服电机转动一周的点云数据中的激光点在所述雷达的传感器坐标系中的坐标、所述激光点对应的所述伺服电机的转角和所述雷达与所述虚拟电机坐标系之间的外参将所述点云数据中的激光点坐标转换为所述虚拟电机坐标系中的坐标;
根据转换为所述虚拟电机坐标系中的坐标的激光点形成的点云数据与所述雷达与所述虚拟电机坐标系之间的外参变换矩阵的逆矩阵将所述点云数据中的激光点坐标转换为在所述每一个激光雷达的传感器坐标系下的坐标,得到所述雷达的环境模型。
本发明提供的一种基于伺服电机辅助运动的多激光雷达外参标定装置,其中,第四处理模块74,具体用于:
获取所述多激光雷达中的每一个雷达的环境模型;
对所述多激光雷达中的雷达进行编号1、2、3……N;
获取所述激光雷达的每个雷达的传感器坐标系;
根据所述传感器坐标系依次获取相邻编号的两个雷达的第一外参,其中,编号为N的雷达与标号为1的雷达构成相邻;
根据所述每一个雷达的环境模型和所述第一外参进行迭代优化,得到所述多激光雷达之间的外参。
本发明提供的一种基于伺服电机辅助运动的多激光雷达外参标定装置,其中,第二处理模块72,还具体用于:
根据所述第一点云模型和所述第二点云模型进行KD-tree构建,得到第一多维树和第二多维树;
搜索所述第一点云模型中的每一个第一激光点在所述第二多维树中半径搜索距离小于所述定值的点构成一个点集,并根据所述点集拟合出一个第一平面;
确定所述每一个第一激光点到对应的所述第一平面的第一距离;
搜索所述第二点云模型中的每一个第二激光点在所述第一多维树中半径搜索距离小于所述定值的点构成一个点集,并根据所述点集拟合出一个第二平面;
确定所述每一个第二激光点到对应的所述第二平面的第二距离;
根据所述第一距离和所述第二距离和所述初始外参进行迭代优化,得到最终优化外参作为所述雷达与所述虚拟电机坐标系之间的外参。
本发明提供的一种基于伺服电机辅助运动的多激光雷达外参标定装置,其中,第四处理模块74,还具体用于:
根据所述每一个雷达的环境模型确定对应的点云模型,并对所述点云模型进行KD-tree构建,得到1号多维树、2号多维树、3号多维树……N号多维树;
搜索所述相邻两个雷达中的编号较小的点云模型中的每个激光点在所述编号较大的点云模型所述对应的KD-tree中半径搜索距离小于定值的点构成一个点集,并根据所述点集拟合出一个第三平面,其中,编号为N的雷达与编号为1的雷达相邻时,编号为N的雷达作为编号较小的雷达;
确定所述编号较小的点云模型中的每一个点到对应的所述第三平面的第三距离;
根据所述第三距离和所述第一外参进行迭代优化,得到所述多激光雷达之间的外参。
图8示例了一种电子设备的实体结构示意图,如图8所示,该电子设备可以包括:处理器(processor)810、通信接口(Communications Interface)820、存储器(memory)830和通信总线840,其中,处理器810,通信接口820,存储器830通过通信总线840完成相互间的通信。处理器810可以调用存储器830中的逻辑指令,以执行一种基于伺服电机辅助运动的多激光雷达外参标定方法,该方法包括:构建与多激光雷达中每一个雷达对应的虚拟电机坐标系;根据所述每一个雷达与所述虚拟电机坐标系确定所述雷达与所述虚拟电机坐标系之间的外参;根据所述外参确定对应的所述雷达的环境模型;根据每一个所述雷达的环境模型确定所述多激光雷达之间的外参。
此外,上述的存储器830中的逻辑指令可以通过软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。
另一方面,本发明还提供一种计算机程序产品,所述计算机程序产品包括存储在非暂态计算机可读存储介质上的计算机程序,所述计算机程序包括程序指令,当所述程序指令被计算机执行时,计算机能够执行上述各方法所提供的一种基于伺服电机辅助运动的多激光雷达外参标定方法,该方法包括:构建与多激光雷达中每一个雷达对应的虚拟电机坐标系;根据所述每一个雷达与所述虚拟电机坐标系确定所述雷达与所述虚拟电机坐标系之间的外参;根据所述外参确定对应的所述雷达的环境模型;根据每一个所述雷达的环境模型确定所述多激光雷达之间的外参。
又一方面,本发明还提供一种非暂态计算机可读存储介质,其上存储有计算机程序,该计算机程序被处理器执行时实现以执行上述各提供的一种基于伺服电机辅助运动的多激光雷达外参标定方法,该方法包括:构建与多激光雷达中每一个雷达对应的虚拟电机坐标系;根据所述每一个雷达与所述虚拟电机坐标系确定所述雷达与所述虚拟电机坐标系之间的外参;根据所述外参确定对应的所述雷达的环境模型;根据每一个所述雷达的环境模型确定所述多激光雷达之间的外参。
以上所描述的装置实施例仅仅是示意性的,其中所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施例方案的目的。本领域普通技术人员在不付出创造性的劳动的情况下,即可以理解并实施。
通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到各实施方式可借助软件加必需的通用硬件平台的方式来实现,当然也可以通过硬件。基于这样的理解,上述技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来,该计算机软件产品可以存储在计算机可读存储介质中,如ROM/RAM、磁碟、光盘等,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行各个实施例或者实施例的某些部分所述的方法。
最后应说明的是:以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (10)
1.一种基于伺服电机辅助运动的多激光雷达外参标定方法,其特征在于,包括:
构建与多激光雷达中每一个激光雷达对应的虚拟电机坐标系;
根据所述每一个激光雷达与所述虚拟电机坐标系确定所述激光雷达与所述虚拟电机坐标系之间的外参;
根据所述外参确定对应的所述激光雷达的环境模型;
根据每一个所述激光雷达的环境模型确定所述多激光雷达之间的外参。
2.根据权利要求1所述的基于伺服电机辅助运动的多激光雷达外参标定方法,其特征在于,所述构建与多激光雷达中每一个激光雷达对应的虚拟电机坐标系,具体包括:
获取所述每一个激光雷达的传感器坐标系;
将所述激光雷达的传感器坐标系经过最少量转动和最少量的平移后,使得所述激光雷达的传感器坐标系的任意一个坐标轴与伺服电机转动轴在空间中达到重合,得到转换后的激光雷达的传感器坐标系;
将所述转换后的激光雷达的传感器坐标系作为所述激光雷达对应的虚拟电机坐标系。
3.根据权利要求2所述的基于伺服电机辅助运动的多激光雷达外参标定方法,其特征在于,所述根据所述每一个激光雷达与所述虚拟电机坐标系确定所述激光雷达与所述虚拟电机坐标系之间的外参,具体包括:
获取所述每一个激光雷达的传感器坐标系与所述激光雷达对应的虚拟电机坐标系的位姿转换结果作为初始外参;
获取所述每一个激光雷达随所述伺服电机转动一周的点云数据中的激光点在所述激光雷达的传感器坐标系中的坐标和所述激光点对应的所述伺服电机的转角;
根据所述初始外参和所述伺服电机的转角将所述激光点在所述激光雷达的传感器坐标系中的坐标转换为所述激光点在所述虚拟电机坐标系中的坐标;
根据所述第一点云模型和所述第二点云模型对所述初始外参进行迭代优化,得到最终优化外参作为所述激光雷达与所述虚拟电机坐标系之间的外参。
4.根据权利要求3所述的基于伺服电机辅助运动的多激光雷达外参标定方法,其特征在于,所述根据所述外参确定对应的所述激光雷达的环境模型,具体包括:
根据所述每一个激光雷达随所述伺服电机转动一周的点云数据中的激光点在所述激光雷达的传感器坐标系中的坐标、所述激光点对应的所述伺服电机的转角和所述激光雷达与所述虚拟电机坐标系之间的外参将所述点云数据中的激光点坐标转换为所述虚拟电机坐标系中的坐标;
根据转换为所述虚拟电机坐标系中的坐标的激光点形成的点云数据与所述激光雷达与所述虚拟电机坐标系之间的外参变换矩阵的逆矩阵将所述点云数据中的激光点坐标转换为在所述每一个激光雷达的传感器坐标系下的坐标,得到所述激光雷达的环境模型。
5.根据权利要求4所述的基于伺服电机辅助运动的多激光雷达外参标定方法,其特征在于,所述根据每一个所述激光雷达的环境模型确定所述多激光雷达的外参,具体包括:
获取所述多激光雷达中的每一个激光雷达的环境模型;
对所述多激光雷达中的激光雷达进行编号1、2、3……N;
获取所述激光雷达的每个激光雷达的传感器坐标系;
根据所述传感器坐标系依次获取相邻编号的两个激光雷达的第一外参,其中,编号为N的激光雷达与标号为1的激光雷达构成相邻;
根据所述每一个激光雷达的环境模型和所述第一外参进行迭代优化,得到所述多激光雷达的外参。
6.根据权利要求3所述的基于伺服电机辅助运动的多激光雷达外参标定方法,其特征在于,所述根据所述第一点云模型和所述第二点云模型对所述初始外参进行迭代优化,得到最终优化外参作为所述激光雷达与所述虚拟电机坐标系之间的外参,具体包括:
根据所述第一点云模型和所述第二点云模型进行KD-tree构建,得到第一多维树和第二多维树;
搜索所述第一点云模型中的每一个第一激光点在所述第二多维树中半径搜索距离小于定值的点构成一个点集,并根据所述点集拟合出一个第一平面;
确定所述每一个第一激光点到对应的所述第一平面的第一距离;
搜索所述第二点云模型中的每一个第二激光点在所述第一多维树中半径搜索距离小于所述定值的点构成一个点集,并根据所述点集拟合出一个第二平面;
确定所述每一个第二激光点到对应的所述第二平面的第二距离;
根据所述第一距离和所述第二距离和所述初始外参进行迭代优化,得到最终优化外参作为所述激光雷达与所述虚拟电机坐标系之间的外参。
7.根据权利要求5所述的基于伺服电机辅助运动的多激光雷达外参标定方法,其特征在于,所述根据所述每一个激光雷达的环境模型和所述第一外参进行迭代优化,得到所述多激光雷达之间的外参,具体包括:
根据所述每一个激光雷达的环境模型确定对应的点云模型,并对所述点云模型进行KD-tree构建,得到1号多维树、2号多维树、3号多维树……N号多维树;
搜索所述相邻两个激光雷达中的编号较小的激光雷达的点云模型中的每个激光点在所述编号较大的激光雷达的点云模型所述对应的KD-tree中半径搜索距离小于定值的点构成一个点集,并根据所述点集拟合出一个第三平面,其中,编号为N的激光雷达与编号为1的激光雷达相邻时,编号为N的激光雷达作为编号较小的激光雷达;
确定所述编号较小的激光雷达的点云模型中的每一个点到对应的所述第三平面的第三距离;
根据所述第三距离和所述第一外参进行迭代优化,得到所述多激光雷达之间的外参。
8.一种基于伺服电机辅助运动的多激光雷达外参标定装置,其特征在于,包括:
第一处理模块,用于构建与多激光雷达中每一个激光雷达对应的虚拟电机坐标系;
第二处理模块,用于根据所述每一个激光雷达与所述虚拟电机坐标系确定所述激光雷达与所述虚拟电机坐标系之间的外参;
第三处理模块,用于根据所述外参确定对应的所述激光雷达的环境模型;
第四处理模块,用于根据每一个所述激光雷达的环境模型确定所述多激光雷达之间的外参。
9.一种电子设备,包括存储器、处理器及存储在所述存储器上并在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述程序时实现如权利要求1至7任一项所述基于伺服电机辅助运动的多激光雷达外参标定方法的步骤。
10.一种非暂态计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现如权利要求1至7任一项所述基于伺服电机辅助运动的多激光雷达外参标定方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111330346.4A CN113777593B (zh) | 2021-11-11 | 2021-11-11 | 基于伺服电机辅助运动的多激光雷达外参标定方法和装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111330346.4A CN113777593B (zh) | 2021-11-11 | 2021-11-11 | 基于伺服电机辅助运动的多激光雷达外参标定方法和装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113777593A CN113777593A (zh) | 2021-12-10 |
CN113777593B true CN113777593B (zh) | 2022-03-04 |
Family
ID=78873749
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111330346.4A Active CN113777593B (zh) | 2021-11-11 | 2021-11-11 | 基于伺服电机辅助运动的多激光雷达外参标定方法和装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113777593B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114217280B (zh) * | 2021-12-22 | 2024-07-19 | 大连理工大学 | 一种外置旋转二维激光雷达外部参数的标定方法 |
CN114152937B (zh) * | 2022-02-09 | 2022-05-17 | 西南科技大学 | 一种旋转激光雷达的外参标定方法 |
CN114758005B (zh) * | 2022-03-23 | 2023-03-28 | 中国科学院自动化研究所 | 激光雷达与相机外参标定方法及装置 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105818763A (zh) * | 2016-03-09 | 2016-08-03 | 乐卡汽车智能科技(北京)有限公司 | 一种确定车辆周围物体距离的方法、装置及*** |
CN111025331A (zh) * | 2019-12-25 | 2020-04-17 | 湖北省国土资源研究院(湖北省国土资源厅不动产登记中心) | 一种基于旋转结构的激光雷达建图方法及其扫描*** |
CN111830498A (zh) * | 2020-07-29 | 2020-10-27 | 成都纳雷科技有限公司 | 基于毫米波区域安防的多雷达自动组网方法及*** |
CN112305557A (zh) * | 2020-10-20 | 2021-02-02 | 深圳无境智能机器人有限公司 | 一种全景相机与多线激光雷达外参标定*** |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10663590B2 (en) * | 2017-05-01 | 2020-05-26 | Symbol Technologies, Llc | Device and method for merging lidar data |
-
2021
- 2021-11-11 CN CN202111330346.4A patent/CN113777593B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105818763A (zh) * | 2016-03-09 | 2016-08-03 | 乐卡汽车智能科技(北京)有限公司 | 一种确定车辆周围物体距离的方法、装置及*** |
CN111025331A (zh) * | 2019-12-25 | 2020-04-17 | 湖北省国土资源研究院(湖北省国土资源厅不动产登记中心) | 一种基于旋转结构的激光雷达建图方法及其扫描*** |
CN111830498A (zh) * | 2020-07-29 | 2020-10-27 | 成都纳雷科技有限公司 | 基于毫米波区域安防的多雷达自动组网方法及*** |
CN112305557A (zh) * | 2020-10-20 | 2021-02-02 | 深圳无境智能机器人有限公司 | 一种全景相机与多线激光雷达外参标定*** |
Also Published As
Publication number | Publication date |
---|---|
CN113777593A (zh) | 2021-12-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113777593B (zh) | 基于伺服电机辅助运动的多激光雷达外参标定方法和装置 | |
CN109521403B (zh) | 多线激光雷达的参数标定方法及装置、设备及可读介质 | |
CN107301654B (zh) | 一种多传感器的高精度即时定位与建图方法 | |
Li et al. | A robot hand-eye calibration method of line laser sensor based on 3D reconstruction | |
CN107063228B (zh) | 基于双目视觉的目标姿态解算方法 | |
CN111199564A (zh) | 智能移动终端的室内定位方法、装置与电子设备 | |
CN111123242B (zh) | 一种基于激光雷达和相机的联合标定方法及计算机可读存储介质 | |
CN112258590B (zh) | 一种基于激光的深度相机外参标定方法、设备及其存储介质 | |
CN114219717A (zh) | 点云配准方法、装置、电子设备及存储介质 | |
CN111047652B (zh) | 一种快速的多tof相机外参标定方法和装置 | |
CN114758005B (zh) | 激光雷达与相机外参标定方法及装置 | |
CN116862955A (zh) | 一种植物图像的三维配准方法、***及设备 | |
CN114140539A (zh) | 一种室内物体的位置获取方法和装置 | |
CN111915681A (zh) | 多组3d相机群的外参标定方法、装置、存储介质及设备 | |
CN115100287A (zh) | 外参标定方法及机器人 | |
CN106651950B (zh) | 一种基于二次曲线透视投影不变性的单相机位姿估计方法 | |
JP2002175521A (ja) | 三次元データ処理装置および三次元データ処理方法、並びにプログラム提供媒体 | |
CN113865506A (zh) | 一种无标志点拼接的自动化三维测量方法及*** | |
CN113920267A (zh) | 三维场景模型构建方法、装置、设备及存储介质 | |
Guo et al. | 3D Lidar SLAM Based on Ground Segmentation and Scan Context Loop Detection | |
Kim et al. | Simultaneous registration of multiple views with markers | |
Mirzaei et al. | Analytical least-squares solution for 3d lidar-camera calibration | |
CN117807875B (zh) | 石英器件的三维数据逆向重建和尺寸测量***及方法 | |
Brahmanage et al. | Building 2D Maps with Integrated 3D and Visual Information using Kinect Sensor | |
CN117036508A (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |