CN109765567B - 基于长方体标定物的二维激光测距仪定位方法 - Google Patents
基于长方体标定物的二维激光测距仪定位方法 Download PDFInfo
- Publication number
- CN109765567B CN109765567B CN201910111601.2A CN201910111601A CN109765567B CN 109765567 B CN109765567 B CN 109765567B CN 201910111601 A CN201910111601 A CN 201910111601A CN 109765567 B CN109765567 B CN 109765567B
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- calibration object
- range finder
- calibration
- cuboid
- 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
Landscapes
- Optical Radar Systems And Details Thereof (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明公开了基于长方体标定物的二维激光测距仪定位方法,涉及激光测距技术领域,主要包括以下步骤:将制作好的标定物放在激光测距仪的发射器的侧下方,发射器在扫描面内转动并向标定物发射激光,激光经过标定物反射后被激光测距仪接收到,得到标定物表面上的被测点,拟合被测点得到四条直线段,根据直线段计算标定物坐标系和测距仪坐标系之间的转换矩阵,并根据转换方程确定标定物坐标系和测距仪坐标系之间的转换关系。本发明的方法只需使用三个长方体标定物,并且在这些标定物中只需要知道其中一个的高度,在获得一组轮廓数据后,通过后续步骤明确的计算,即可获得测距仪位置。标定物极易制作,计算方法也易于实现,具有很强的实用性。
Description
技术领域
本发明涉及激光测距技术领域,特别是涉及基于长方体标定物的二维激光测距仪定位方法。
背景技术
激光测距仪通过发射激光来测量光源和被照射点的距离,根据发射方向分为一维、二维和三维等类别。其中二维激光测距仪在一个平面内连续发出多个角度的激光脉冲,获得一组距离数据,代表了被扫描物体(场景)的一条表面轮廓线,由于价格适中,因此广泛用于轮廓测量、区域监控和定位。
测距仪发出的激光分为两种,可见光和不可见光,其中不可见光由于没有明显的视觉特征,因此不能用传统的基于图像的方法进行测距仪的标定;另外由于获取的轮廓数据虽然对应于周边场景,但是数据量偏小,如果事先无法确定场景形状,则给标定测距仪带来很大困难。
发明内容
本发明实施例提供了基于长方体标定物的二维激光测距仪定位方法,可以解决现有技术中存在的问题。
本发明提供了基于长方体标定物的二维激光测距仪定位方法,该方法包括以下步骤:
步骤1,将制作好的标定物放在激光测距仪的发射器的侧下方,其中所述标定物的数量为三个,均为长方体,其中两个长方体标定物相互紧贴并放在其余一个长方体标定物的上表面上,位于上方的两个所述长方体标定物中靠近所述发射器的长方体标定物的高度已知,且该已知高度的长方体标定物高度小于远离所述发射器的长方体标定物的高度;
步骤2,所述发射器在扫描面内转动并向所述标定物发射激光,激光经过标定物反射后被激光测距仪接收到,得到标定物表面上多个被测点,拟合这些被测点得到四条直线段;
步骤3,根据拟合得到的直线段计算标定物坐标系和测距仪坐标系之间的转换矩阵,并根据下式确定标定物坐标系和测距仪坐标系之间的转换方程:
C=RM+T
其中C为标定物坐标系中的坐标,表示为C=(X,Y,Z),M为测距仪坐标系中的坐标,表示为M=(x,y,z),R和T均为转换矩阵,二者分别表示为:
其中,(r1 r2 r3)T、(r4 r5 r6)T和(r7 r8 r9)T分别是测距仪坐标系中x、y和z轴在标定物坐标系中的单位向量,(tx ty tz)T是测距仪坐标系的原点o在标定物坐标系中的坐标。
本发明实施例中的基于长方体标定物的二维激光测距仪定位方法,只需使用三个长方体标定物,并且在这些标定物中,只需要预先知道其中一个的高度数值即可,在获得一组轮廓数据后,通过后续步骤明确的计算,即可获得测距仪位置。标定物极易制作,计算方法也易于实现,具有很强的实用性。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明实施例提供的基于长方体标定物的二维激光测距仪定位方法的流程图;
图2为定位过程中使用的长方体标定物和激光测距仪的发射器的示意图;
图3为扫描平面内轮廓线和发射器的示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
激光扫描测距仪能够通过旋转的光学部件发射二维扫描面,返回被测物体表面点和光心的距离,以实现轮廓测量功能。具体原理为:测距仪内部的发射器发出激光脉冲,内部定时器开始计时,当激光脉冲碰到物体后,部分能量返回。当接收器收到返回激光时,定时器停止计时。从发射器光心到物体的距离通过光速和时差计算获得。在扫描面内的每个被测点以极坐标表示,即(L,β),L表示距离光心的距离,β表示扫描线和测距仪坐标系x轴的夹角。
参照图1,本发明提供了基于长方体标定物的二维激光测距仪定位方法,该方法包括以下步骤:
步骤1,将制作好的标定物放在激光测距仪的发射器的侧下方,其中所述标定物的数量为三个,均为长方体,其中两个长方体标定物相互紧贴并放在其余一个长方体标定物的上表面上,位于上方的两个所述长方体标定物中靠近所述发射器的长方体标定物的高度已知为h,且该已知高度的长方体标定物高度小于远离所述发射器的长方体标定物的高度。
在本实施例中,三个所述长方体标定物可以自行制作,需要使用具有一定反射率的材料制成,例如木头、金属或者毛玻璃等。且长方体标定物的形状要规整精确,尺寸不限,只需要提前测量其中一个的高度即可。
步骤2,所述发射器在扫描面内转动并向所述标定物发射激光,激光经过标定物反射后被激光测距仪接收到,得到标定物表面上一系列离散的被测点,拟合这些被测点即可得到四条直线段,如图2和3中的线段ab、bc、cd和de所示。
步骤3,根据拟合得到的直线段计算标定物坐标系和测距仪坐标系之间的转换矩阵,并根据下式确定标定物坐标系和测距仪坐标系之间的转换方程:
C=RM+T
其中C为标定物坐标系中的坐标,表示为C=(X,Y,Z),M为测距仪坐标系中的坐标,表示为M=(x,y,z),R和T均为转换矩阵,二者分别表示为:
其中,(r1 r2 r3)T、(r4 r5 r6)T和(r7 r8 r9)T分别是测距仪坐标系中x、y和z轴在标定物坐标系中的单位向量,(tx ty tz)T是测距仪坐标系的原点o在标定物坐标系中的坐标。
如图2所示,标定物坐标系的原点O为已知高度的长方体坐标系的一个顶点,X轴和Y轴分别为从该顶点出发的相邻两条边,Z轴经过原点O竖直向上,测距仪坐标系的原点o位于发射器的光心处,x轴和y轴如图所示,均位于扫描面π2内,z轴由右手坐标原则确定,与扫描面π2垂直。
步骤3中转换矩阵R和T的计算过程如下:
在测距仪的二维坐标系下(忽略z轴),求四条直线段的三个交点,即ab和bc的交点b(xb,yb)、bc和cd的交点c(xc,yc)、cd和de的交点d(xd,yd)。
分别求出线段cb的长度|cb|、线段cd的长度|cd|、两条线段之间的夹角α。
在标定物坐标系下,线段cd对应的向量为标准化后成为单位向量线段cb对应的单位向量为其中t为未知数,根据可计算出t。再根据线段cb的长度|cb|和cd的长度|cd|,可求出b点、c点和d点在标定物坐标系下的坐标,分别记为Xb、Xc和Xd。
在测距仪坐标系下,计算b点、c点、d点和测距仪光心o的距离,分别记作|ob|、|oc|、|od|。在标定物坐标系下,令测距仪光心o的坐标为Xo,建立如下方程组:
求得测距仪光心o在标定物坐标系下的坐标Xo,记为(tx ty tz)T。
在测距仪坐标下,选择ob、oc和od中的任意一条线段,例如ob,求得其与测距仪坐标系x轴的夹角,记为βb。在标定物坐标系下,将向量沿扫描面π2的法向量顺时针旋转βb,即可确定测距仪坐标系的x轴在标定物坐标系下的单位向量,记为(r1 r2 r3)T。
将(r1 r2 r3)T和扫描面π2的法向量(r7 r8 r9)T做叉积运算并标准化,即可求得测距仪坐标系的y轴在标定物坐标系下的单位向量(r4 r5 r6)T。至此,测距仪坐标系和标定物坐标系的转换矩阵R和T全部确定。
实施例
本发明的方法可用于车辆轮廓的测量系统。该系统由两个二维激光测距仪组成,分别固定安装在左右两根柱子上,并且使用本发明的标定方法进行了空间定位。车辆从两根柱子中间缓慢通过时,两个激光测距仪获得运动中的汽车的连续的两组轮廓线。由于测距仪已经标定过,因此可以将两组轮廓线从各自的测距仪坐标系变换到统一的标定物坐标系,形成车辆的完整轮廓,从而计算出车辆的长、宽、高等数据。
尽管已描述了本发明的优选实施例,但本领域内的技术人员一旦得知了基本创造性概念,则可对这些实施例做出另外的变更和修改。所以,所附权利要求意欲解释为包括优选实施例以及落入本发明范围的所有变更和修改。
显然,本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样,倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内,则本发明也意图包含这些改动和变型在内。
Claims (2)
1.基于长方体标定物的二维激光测距仪定位方法,其特征在于,该方法包括以下步骤:
步骤1,将制作好的标定物放在激光测距仪的发射器的侧下方,其中所述标定物的数量为三个,均为长方体,其中两个长方体标定物相互紧贴并放在其余一个长方体标定物的上表面上,位于上方的两个所述长方体标定物中靠近所述发射器的长方体标定物的高度已知,且该已知高度的长方体标定物高度小于远离所述发射器的长方体标定物的高度;
步骤2,所述发射器在扫描面内转动并向所述标定物发射激光,激光经过标定物反射后被激光测距仪接收到,得到标定物表面上多个被测点,拟合这些被测点得到四条直线段;
步骤3,根据拟合得到的直线段计算标定物坐标系和测距仪坐标系之间的转换矩阵,并根据下式确定标定物坐标系和测距仪坐标系之间的转换方程:
C=RM+T
其中C为标定物坐标系中的坐标,表示为C=(X,Y,Z),M为测距仪坐标系中的坐标,表示为M=(x,y,z),R和T均为转换矩阵,二者分别表示为:
其中,(r1 r2 r3)T、(r4 r5 r6)T和(r7 r8 r9)T分别是测距仪坐标系中x、y和z轴在标定物坐标系中的单位向量,(tx ty tz)T是测距仪坐标系的原点o在标定物坐标系中的坐标;
步骤3中转换矩阵R和T的计算过程为:
在测距仪的二维坐标系下,求四条直线段的三个交点,即ab和bc的交点b(xb,yb)、bc和cd的交点c(xc,yc)、cd和de的交点d(xd,yd);
分别求出线段cb的长度|cb|、线段cd的长度|cd|、两条线段之间的夹角α;
在标定物坐标系下,线段cd对应的向量为标准化后成为单位向量其中h为已知高度的标定物的高度;线段cb对应的单位向量为根据计算出t;再根据线段cb的长度|cb|和cd的长度|cd|,求出b点、c点和d点在标定物坐标系下的坐标,分别记为Xb、Xc和Xd;
在测距仪坐标系下,计算b点、c点、d点和测距仪光心o的距离,分别记作|ob|、|oc|、|od|,在标定物坐标系下,令测距仪光心o的坐标为Xo,建立如下方程组:
求得测距仪光心o在标定物坐标系下的坐标Xo,记为(tx ty tz)T;
在测距仪坐标下,选择ob、oc和od中的任意一条线段,假设选择ob,求得其与测距仪坐标系x轴的夹角,记为βb,在标定物坐标系下,将向量沿扫描面π2的法向量顺时针旋转βb,确定测距仪坐标系的x轴在标定物坐标系下的单位向量,记为(r1 r2 r3)T;
将(r1 r2 r3)T和扫描面π2的法向量(r7 r8 r9)T做叉积运算并标准化,求得测距仪坐标系的y轴在标定物坐标系下的单位向量(r4 r5 r6)T。
2.如权利要求1所述的基于长方体标定物的二维激光测距仪定位方法,其特征在于,三个所述长方体标定物使用木头、金属或者毛玻璃材料制成。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910111601.2A CN109765567B (zh) | 2019-02-12 | 2019-02-12 | 基于长方体标定物的二维激光测距仪定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910111601.2A CN109765567B (zh) | 2019-02-12 | 2019-02-12 | 基于长方体标定物的二维激光测距仪定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109765567A CN109765567A (zh) | 2019-05-17 |
CN109765567B true CN109765567B (zh) | 2023-05-16 |
Family
ID=66454710
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910111601.2A Active CN109765567B (zh) | 2019-02-12 | 2019-02-12 | 基于长方体标定物的二维激光测距仪定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109765567B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113847872A (zh) * | 2020-06-28 | 2021-12-28 | 中铁上海工程局集团有限公司 | 一种基于激光测距的离散单点位移静态监测装置及方法 |
CN116147635B (zh) * | 2023-04-17 | 2023-07-28 | 天津宜科自动化股份有限公司 | 一种应用于多轮廓传感器的处理方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104656097A (zh) * | 2015-01-28 | 2015-05-27 | 武汉理工大学 | 基于旋转式二维激光三维重构系统的标定装置及方法 |
CN105445721A (zh) * | 2015-12-15 | 2016-03-30 | 中国北方车辆研究所 | 基于带特征突起v型标定物的激光雷达与摄像机联合标定方法 |
CN105444672A (zh) * | 2015-12-17 | 2016-03-30 | 华科精准(北京)医疗科技有限公司 | 激光测距仪和机械臂末端关系的正交平面标定方法及系统 |
CN108596117A (zh) * | 2018-04-28 | 2018-09-28 | 河北工业大学 | 一种基于二维激光测距仪阵列的场景监控方法 |
-
2019
- 2019-02-12 CN CN201910111601.2A patent/CN109765567B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104656097A (zh) * | 2015-01-28 | 2015-05-27 | 武汉理工大学 | 基于旋转式二维激光三维重构系统的标定装置及方法 |
CN105445721A (zh) * | 2015-12-15 | 2016-03-30 | 中国北方车辆研究所 | 基于带特征突起v型标定物的激光雷达与摄像机联合标定方法 |
CN105444672A (zh) * | 2015-12-17 | 2016-03-30 | 华科精准(北京)医疗科技有限公司 | 激光测距仪和机械臂末端关系的正交平面标定方法及系统 |
CN108596117A (zh) * | 2018-04-28 | 2018-09-28 | 河北工业大学 | 一种基于二维激光测距仪阵列的场景监控方法 |
Non-Patent Citations (2)
Title |
---|
Extrinsic Calibration of 2D Laser Rangefinders from Perpendicular Plane Observations;Eduardo Fernández-Moral等;《The International Journal of Robotics Research》;20150526;第34卷(第11期);全文 * |
Extrinsic Calibration of 2D Laser Rangefinders Using an Existing Cuboid-Shaped Corridor as the Reference;Deyu Yin等;《Sensor》;20181210;第18卷(第12期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN109765567A (zh) | 2019-05-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR102086940B1 (ko) | 3차원 비접촉 스캐닝 시스템의 현장 교정 | |
CN107014312B (zh) | 一种振镜式线激光扫描三维测量系统的整体标定方法 | |
CN110068270B (zh) | 一种基于多线结构光图像识别的单目视觉箱体体积测量方法 | |
CN101901501B (zh) | 一种生成激光彩色云图的方法 | |
CN108759669B (zh) | 一种室内自定位三维扫描方法及系统 | |
Zámečníková et al. | Influence of surface reflectivity on reflectorless electronic distance measurement and terrestrial laser scanning | |
CN105960569B (zh) | 使用二维图像处理来检查三维物体的方法 | |
CN103411553A (zh) | 多线结构光视觉传感器的快速标定方法 | |
CN108692656B (zh) | 一种激光扫描数据获取方法及装置 | |
CN111208493B (zh) | 一种车载激光雷达在整车坐标系下的快速标定方法 | |
CN104007444A (zh) | 一种基于中心投影的地面激光雷达反射强度图像的生成方法 | |
CN103759669A (zh) | 一种大型零件的单目视觉测量方法 | |
CN109765567B (zh) | 基于长方体标定物的二维激光测距仪定位方法 | |
CN113096183B (zh) | 一种基于激光雷达与单目相机的障碍物检测与测量方法 | |
US10319142B2 (en) | Method for visualizing three dimensional data | |
CN110703230A (zh) | 激光雷达与摄像头之间的位置标定方法 | |
CN113074660B (zh) | 一种大尺寸透明物体的面型测量方法 | |
CN101515331A (zh) | 一种邻域相关的亚像素定位方法 | |
SE509005C2 (sv) | Förfarande och arrangemang för beröringsfri inmätning av den tre-dimensionella formen hos detala objekt | |
US9996946B2 (en) | Maintenance supporting system and maintenance supporting method utilizing a reference image and indicator | |
CN112945109B (zh) | 基于水平位移台的激光位移计阵列系统参数标定方法 | |
CN110208777B (zh) | 精确的角反射器几何误差测量方法 | |
CN105157597A (zh) | 一种激光测量效应靶变形的方法 | |
CN105809685B (zh) | 一种基于单幅同心圆图像的摄像机定标方法 | |
CN116859361A (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 |