CN110132130A - 激光雷达位置标定方法、系统及其数据处理方法、系统 - Google Patents

激光雷达位置标定方法、系统及其数据处理方法、系统 Download PDF

Info

Publication number
CN110132130A
CN110132130A CN201910163814.XA CN201910163814A CN110132130A CN 110132130 A CN110132130 A CN 110132130A CN 201910163814 A CN201910163814 A CN 201910163814A CN 110132130 A CN110132130 A CN 110132130A
Authority
CN
China
Prior art keywords
data
point cloud
cloud data
point
laser radar
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
Application number
CN201910163814.XA
Other languages
English (en)
Inventor
温从标
蒋祖武
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shanghai Bingtong Intelligent Technology Co Ltd
Original Assignee
Shanghai Bingtong Intelligent Technology Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Shanghai Bingtong Intelligent Technology Co Ltd filed Critical Shanghai Bingtong Intelligent Technology Co Ltd
Priority to CN201910163814.XA priority Critical patent/CN110132130A/zh
Publication of CN110132130A publication Critical patent/CN110132130A/zh
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B11/00Measuring arrangements characterised by the use of optical techniques
    • G01B11/002Measuring arrangements characterised by the use of optical techniques for measuring two or more coordinates
    • G01B11/005Measuring arrangements characterised by the use of optical techniques for measuring two or more coordinates coordinate measuring machines

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Length Measuring Devices By Optical Means (AREA)

Abstract

本发明提供了一种激光雷达位置标定方法、系统及其数据处理方法、系统,该数据处理方法,包括:获取测量点云数据,所述测量点云数据是安装于车辆的激光雷达扫描安装于所述车辆的标定件而产生的;所述标定件在水平面的投影与所述车辆在水平面的投影相匹配;所述标定件调整后的高度与所述激光雷达的高度相匹配;根据所述测量点云数据与理论点云数据,确定所述测量点云数据与所述理论点云数据的目标匹配关系;根据所述目标匹配关系,以及标定件位置信息,确定所述激光雷达的雷达位置信息,所述雷达位置信息用于表征所述激光雷达相对于所述AVG中心的位置。本发明在AVG的导引时不会再受到安装时对加工精度、装配容差、人为操作等因素的影响。

Description

激光雷达位置标定方法、系统及其数据处理方法、系统
技术领域
本发明涉及AGV领域,尤其涉及一种激光雷达位置标定方法、系统及其 数据处理方法、系统。
背景技术
AGV是Automated Guided Vehicle的缩写,意即“自动导引运输车辆”。 AGV是装备有电磁或光学等自动导引装置,能够沿规定的导引路径行驶, 具有安全保护以及各种移载功能的运输车。激光雷达,是以发射激光束探 测目标相关信息的雷达系统。通过激光雷达,可以采集到点云数据。
现有的相关技术中,激光雷达探测到的信息可用于作为车辆自动导引 的依据之一,此时,激光雷达相对于AGV中心的位置就显得尤为重要, 具体的,可以在AGV中基于激光雷达在安装时的理论位置来协助自动导 引。
然而,由于没有合适的技术和方法,现有的AGV中激光雷达安装都 是通过人眼观察手动安装的。同时,由于测量复杂又有限制,往往激光雷 达的位置都是通过他们各自的在AGV的理论安装位置来确定。定位的精 度不仅依赖于机械加工精度和装配容差,同时还依赖于安装工人的熟练水 平。加工水平和装配工艺以及人为操作直接影响到AGV中心与激光雷达 之间的相对位置精度。
这种定位方式存在很多的不足:例如要求机械加工精度高,装配误差 小,制造成本高;再例如激光雷达的安装有一部分是通过人为操作,误差 大且不易于控制。
基于该种定位方式的不足,在AGV中若使用安装时的理论位置来协 助自动导引,易于导致自动导引的不当。
发明内容
本发明提供一种激光雷达位置标定方法、系统及其数据处理方法、系统, 以解决AGV中若使用安装时的理论位置来协助自动导引,易于导致自动导引 的不当的问题。
根据本发明的第一方面,提供了一种激光雷达位置标定的数据处理方法, 包括:
获取测量点云数据,所述测量点云数据是安装于车辆的激光雷达扫描安 装于所述车辆的标定件而产生的;所述标定件在水平面的投影与所述车辆在 水平面的投影相匹配;所述标定件调整后的高度与所述激光雷达的高度相匹 配;
根据所述测量点云数据与理论点云数据,确定所述测量点云数据与所述 理论点云数据的目标匹配关系;所述目标匹配关系用于表征所述测量点云数 据中数据点与所述理论点云数据中数据点的一种空间坐标转换的方式,所述 测量点云数据与所述理论点云数据是不同坐标系下的;
根据所述目标匹配关系,以及标定件位置信息,确定所述激光雷达的雷 达位置信息,所述标定件位置信息用于表征所述标定件相对于所述车辆的 AVG中心的位置,所述雷达位置信息用于表征所述激光雷达相对于所述AVG 中心的位置。
可选的,所述激光雷达为3D激光雷达,所述测量点云数据与所述理论 点云数据为三维的点云数据。
可选的,所述根据所述测量点云数据与理论点云数据,确定所述测量点 云数据与所述理论点云数据的目标匹配关系,包括:
计算所述测量点云数据中的数据点与所述理论点云数据的数据点的残差, 并确定所述残差为最小值时所述测量点云数据与所述理论点云数据间的匹配 关系,并以此为所述目标匹配关系。
可选的,所述激光雷达为2D激光雷达,所述测量点云数据与所述理论 点云数据为二维的点云数据。
可选的,所述根据所述测量点云数据与理论点云数据,确定所述测量点 云数据与所述理论点云数据的目标匹配关系,包括:
确定所述测量点云数据中数据点所形成的N个测量线段,每个测量线段 对应于一个理论线段,所述理论线段是所述理论点云数据中数据点所形成的; 其中的N为大于或等于1的整数;所述N个测量线段是连续的;
在同一参考平面中,计算各测量线段中各数据点与对应理论线段中各数 据点的距离;并确定所述距离的总和为最小值时所述测量点云数据与所述理 论点云数据间的匹配关系,并以此为所述目标匹配关系。
可选的,N为3,且三个连续的测量线段对应于四个端点;所述确定所 述测量点云数据中数据点所形成的N个测量线段,包括:
确定所述测量点云数据中数据点的初始数据点与末尾数据点;所述初始 数据点为所述N个测量线段的第一个端点,所述末尾数据点为所述N个测量 线段的第四个端点;
在所述测量点云数据中任意取一个参考数据点;所述参考数据点为相距 所述初始数据点与末尾数据点的连线最远的至少一个数据点中的其中之一;
计算所述参考数据点与所述初始数据点之间各数据点相距第一参考线的 第一间距,并确定所述第一间距为最大值时的数据点为第二个端点;所述第 一参考线为连接所述参考数据点与所述初始数据点形成的;
计算所述参考数据点与所述末尾数据点之间各数据点相距第二参考线的 第二间距,并确定所述第二间距为最大值时的数据点为第三个端点;所述第 二参考线段为连接所述参考数据点与所述末尾数据点形成的。
根据本发明的第二方面,提供了一种激光雷达位置标定的数据处理装置, 包括:
获取模块,用于获取测量点云数据,所述测量点云数据是安装于车辆的 激光雷达扫描安装于所述车辆的标定件而产生的;所述标定件在水平面的投 影与所述车辆在水平面的投影相匹配;所述标定件调整后的高度与所述激光 雷达的高度相匹配;
匹配模块,用于根据所述测量点云数据与理论点云数据,确定所述测量 点云数据与所述理论点云数据的目标匹配关系;所述目标匹配关系用于表征 所述测量点云数据中数据点与所述理论点云数据中数据点的一种空间坐标转 换的方式,所述测量点云数据与所述理论点云数据是不同坐标系下的;
位置标定模块,用于根据所述目标匹配关系,以及标定件位置信息,确 定所述激光雷达的雷达位置信息,所述标定件位置信息用于表征所述标定件 相对于所述车辆的AVG中心的位置,所述雷达位置信息用于表征所述激光雷 达相对于所述AVG中心的位置。
可选的,所述激光雷达为3D激光雷达,所述测量点云数据与所述理论 点云数据为三维的点云数据。
可选的,所述匹配模块,具体用于:
计算所述测量点云数据中的数据点与所述理论点云数据的数据点的残差, 并确定所述残差为最小值时所述测量点云数据与所述理论点云数据间的匹配 关系,并以此为所述目标匹配关系。
可选的,所述激光雷达为2D激光雷达,所述测量点云数据与所述理论 点云数据为二维的点云数据。
可选的,所述匹配模块,具体用于:
确定所述测量点云数据中数据点所形成的N个测量线段,每个测量线段 对应于一个理论线段,所述理论线段是所述理论点云数据中数据点所形成的; 其中的N为大于或等于1的整数;所述N个测量线段是连续的;
在同一参考平面中,计算各测量线段中各数据点与对应理论线段中各数 据点的距离;并确定所述距离的总和为最小值时所述测量点云数据与所述理 论点云数据间的匹配关系,并以此为所述目标匹配关系。
可选的,N为3,且三个连续的测量线段对应于四个端点;所述匹配模 块,具体用于:
确定所述测量点云数据中数据点的初始数据点与末尾数据点;所述初始 数据点为所述N个测量线段的第一个端点,所述末尾数据点为所述N个测量 线段的第四个端点;
在所述测量点云数据中任意取一个参考数据点;所述参考数据点为相距 所述初始数据点与末尾数据点的连线最远的至少一个数据点中的其中之一;
计算所述参考数据点与所述初始数据点之间各数据点相距第一参考线的 第一间距,并确定所述第一间距为最大值时的数据点为第二个端点;所述第 一参考线为连接所述参考数据点与所述初始数据点形成的;
计算所述参考数据点与所述末尾数据点之间各数据点相距第二参考线的 第二间距,并确定所述第二间距为最大值时的数据点为第三个端点;所述第 二参考线段为连接所述参考数据点与所述末尾数据点形成的。
根据本发明的第三方面,提供了一种激光雷达位置标定方法,包括:
在车辆的安装激光雷达与标定件;并使得所述标定件在水平面的投影与 所述车辆在水平面的投影相匹配;所述标定件调整后的高度与所述激光雷达 的高度相匹配;
利用第一方面及其可选方案涉及的激光雷达位置标定的数据处理方法确 定所述雷达位置信息。
根据本发明的第四方面,提供了一种激光雷达位置标定系统,包括:安 装于车辆的标定件,以及用于实施第一方面及其可选方案涉及的激光雷达位 置标定的数据处理方法的电子设备;所述电子设备为所述激光雷达本身,或 者:所述电子设备与所述激光雷达连接。
可选的,所述标定件表面为白色和/或,所述标定件表面粘贴有反光带。
根据本发明的第五方面,提供了一种电子设备,包括存储器与处理器;
所述存储器,用于存储所述处理器的可执行指令;
所述处理器配置为经由执行所述可执行指令来执行第一方面及其可选方 案涉及的激光雷达位置标定的数据处理方法。
根据本发明的第五方面,提供了一种存储介质,其上存储有计算机程序, 其特征在于,该程序被处理器执行时实现第一方面及其可选方案涉及的激光 雷达位置标定的数据处理方法。
本发明提供的激光雷达位置标定方法、系统及其数据处理方法、系统, 能够对激光雷达相对于AVG中心的位置进行标定,进而,基于标定后的位置, 在AVG的导引时不会再受到安装时对加工精度、装配容差、人为操作等因素 的影响,有利于避免不当导引的发生,进而,还能使得AVG的装配加工不再 受限于各种加工精度与装配容差的要求,有利于提高装配加工的效率。
同时,本发明提供的激光雷达位置标定方法、系统及其数据处理方法、 系统中,由于其根据测量点云数据与理论点云数据来确定匹配关系,其可有 利于提高位置标定的精度。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实 施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面 描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲, 在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1是本发明一实施例中激光雷达位置标定系统的结构示意图;
图2是本发明一实施例中激光雷达位置标定的数据处理方法的流程示意 图;
图3是本发明一实施例中坐标系的示意图;
图4是本发明一实施例中步骤S12的流程示意图一;
图5是本发明一实施例中步骤S12的流程示意图二;
图6是本发明一实施例中步骤S123的流程示意图;
图7是本发明一实施例中距离计算的示意图;
图8是本发明一实施例中端点计算的示意图;
图9是本发明一实施例中激光雷达位置标定的数据处理装置的模块示意 图;
图10是本发明一实施例中标定件的结构示意图一;
图11是本发明一实施例中标定件的结构示意图二;
图12是本发明一实施例中激光雷达位置标定方法的流程示意图;
图13是本发明一实施例中电子设备的结构示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行 清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而 不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做 出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明的说明书和权利要求书及上述附图中的术语“第一”、“第二”、 “第三”“第四”等(如果存在)是用于区别类似的对象,而不必用于描 述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互 换,以便这里描述的本发明的实施例能够以除了在这里图示或描述的那些 以外的顺序实施。此外,术语“包括”和“具有”以及他们的任何变形, 意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方 法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包 括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤 或单元。
下面以具体地实施例对本发明的技术方案进行详细说明。下面这几个具 体的实施例可以相互结合,对于相同或相似的概念或过程可能在某些实施例 不再赘述。
图1是本发明一实施例中激光雷达位置标定系统的结构示意图。图2是 本发明一实施例中激光雷达位置标定的数据处理方法的流程示意图。
图2所示的方法,可理解用于利用图1所示系统对其中激光雷达的位置 进行标定。
激光雷达位置标定的数据处理方法,包括:
S11:获取测量点云数据。
所述测量点云数据是安装于车辆的激光雷达扫描安装于所述车辆的标定 件而产生的。其中的标定件,可以理解为任意能被激光雷达扫描的适合用于 标定的部件或部件的集合,其具体可以选择外轮廓形状较为便于识别的部件 或部件组合,例如可以为是呈矩形的,该矩形例如如是立体形状的物体的某 一个侧面,通过设置合适的扫描方向,可扫描到该矩形。其他可选方案中, 该外轮廓形状可以变化为三角形、多边形、圆形、不规则图形等等。此外, 该标定件通常可采用便于计算几何中心的形状。
其中,所述标定件3在水平面的投影与所述车辆1在水平面的投影相匹 配;该匹配,可例如标定件3的几何中心在水平面的投影与车辆1的运动中 心在水平面的投影重合,或者距离不超出对应的水平向阈值。
其中,所述标定件3调整后的高度与所述激光雷达2的高度相匹配;该 匹配,可例如标定件3与激光雷达2的高度差小于对应的竖直向阈值,该高 度差可例如理解为标定件3的几何中心与激光雷达2的几何中心的高度差, 也可以例如标定件3最低处与激光雷达2最高处之间的高度差,还可以例如 标定件3最低处与激光雷达2最低处之间的高度差,不论采用何种,只要具 体计算时充分考虑各几何参数,均不脱离本实施例的描述。同时,该高度差可理解为以能够实现标定件3完整扫描为目标所设计的。
图3是本发明一实施例中坐标系的示意图。
请参考图1和图3,以上所涉及的车辆可以为叉车,其仅为一种举例, 本实施例也不排除其他例如卡车、轿车、面包车、公安车、动车车辆、火车 车辆、地铁车辆等的实施可能。
以图3为例,由于标定目的是为了确定激光雷达相对于AGV运动中心之 间的相对位置。图3所示的Of-xyz坐标系是例如叉车的汽车1的坐标系,其 原点是叉车AGV运动中心;坐标系Oc-xyz为标定件3的坐标系,其原点是 标定件3的几何中心;坐标系Ol-xyz为激光雷达2的坐标系,原点是激光雷 达2的几何中心。
标定是安装标定件3与激光雷达的过程可例如如下:
将标定件3固定在叉车1的运动中心位置上方,保证标定件3的几何中 心与叉车AGV运动中心在地面上的投影重合,此时即可使得:所述标定件3 在水平面的投影与所述车辆1在水平面的投影相匹配;然后调整标定件3的 高度,使得激光雷达2与标定件3在同一个高度范围内,由于该车辆1为叉 车,可以升降叉车的叉座来实现,具体还可记录下标定件3上升的高度,以 满足后续标定定位等计算需求。
S12:根据所述测量点云数据与理论点云数据,确定所述测量点云数据与 所述理论点云数据的目标匹配关系。
所述测量点云数据与所述理论点云数据是不同坐标系下的;进而,测量 点云数据是通过测量得到的,而理论点云数据可以是理论数学模型或根据理 论数学模型提取和/或计算确定的,还可以是任意认为设计确定的。
目标匹配关系,可理解为用于表征所述测量点云数据中数据点与所述理 论点云数据中数据点的一种空间坐标转换的方式,其中,可应用于测量点云 数据与理论点云数据间空间坐标转换的方式可以是多样的,步骤S12可确定 一个目标匹配关系,以用于位置标定。而该目标匹配关系相较于其他匹配关 系,可以是一个较佳的匹配关系,例如是更为准确反映坐标系间转换关系的。
其中一种实施方式中,所述激光雷达2可以为3D激光雷达,所述测量 点云数据与所述理论点云数据为三维的点云数据。
图4是本发明一实施例中步骤S12的流程示意图一。
请参考图4,步骤S12可包括:
S121:计算所述测量点云数据中的数据点与所述理论点云数据的数据点 的残差。
测量点云数据可被表征为:S={p1,p2,p3,......pn},理论点云数据可被表征 为:标定件测量点云数据所在坐标系是激光雷达坐标系 Ol-xyz;而标定件理论点云数据所在坐标系是标定件坐标系Oc-xyz。
S122:确定所述残差为最小值时所述测量点云数据与所述理论点云数据 间的匹配关系,并以此为所述目标匹配关系。
标定的核心就是让测量点云数据与理论点云数据匹配,匹配的原理就是 让两者的残差最小化,残差数学模型可例如如下:
其中,
位姿矩阵为:
其中,
H=JT·J
经过多次迭代计算,使得残差E最小,从而得到最优的位姿R、T,该R、 T可理解为对一种匹配关系的表征,其中的R可理解为一种旋转矩阵,T可 理解为一种转移矩阵,可见,步骤S122可具体理解为确定用于表征所述目标 匹配关系的测量点云数据与理论点云数据之间的旋转矩阵与转移矩阵。
另一种实施方式中,所述激光雷达为2D激光雷达,所述测量点云数据 与所述理论点云数据为二维的点云数据。
图5是本发明一实施例中步骤S12的流程示意图二;图6是本发明一实 施例中步骤S123的流程示意图。
请参考图5,步骤S12可包括:
S123:确定所述测量点云数据中数据点所形成的N个测量线段。
每个测量线段对应于一个理论线段,所述理论线段是所述理论点云数据 中数据点所形成的;其中的N为大于或等于1的整数;所述N个测量线段是 连续的;例如若N为3,则可以利用三个线段形成匚字型。
S124:在同一参考平面中,计算各测量线段中各数据点与对应理论线段 中各数据点的距离。
参考平面,可理解为任意能够将测量点云数据与理论点云数据形成于同 一平面的任意平面,例如可以为理论点云数据所处平面,或者测量点云数据 所处平面,对于两种二维的点云,可将其原点对齐后,使其处于同一参考平 面。
图7是本发明一实施例中距离计算的示意图。
请参考图7,该测量线段可以例如为图中所示的线段ab、bc、cd,理论 线段可例如图中所示的线段AB、BC、CD,各线段之间可以是互相垂直的。
测量点云数据可表征为:S={p1,p2,p3,......pn},其形成3段线段ab、bc和 cd。理论点云数据形成3段线段AB、BC和CD。
对应所需计算的距离参照图中的举例来理解,具体例如线段ab中任意的 数据点p1i对应的距离d1i,线段bc中任意的数据点p2i对应的距离d2i,线段 cd中任意的数据点p3i对应的距离d3i。可见,N为3时,对应可形成三个线 段,由于三个线段是连续的,其可具有四个端点。
S125:确定所述距离的总和为最小值时所述测量点云数据与所述理论点 云数据间的匹配关系,并以此为所述目标匹配关系。
2D激光雷达标定的核心就是所有扫描点到对应线段的距离和最小,即完 成测量点云数据与理论点云数据的匹配。
具体的,2D激光雷达标定的数学模型可描述如下:
其中,m表示线段的数量,与标定件形状相关,以上事实方式中,标 定件中m=3;位姿计算可参照步骤S12中位姿的计算理解,即可类似于同 3D激光雷达标定的数据处理过程理解,对此无需重复描述。
其中一种实施方式中,由于雷达扫描仅能扫描到初始数据点,即第一 个数据点与末尾数据点,还需对两部分之间的作为线段端点的数据点进行 识别确定,进而,采用以此为依据确定各线段,只有确定了线段,步骤S123 中才能知道需计算哪些数据点的距离。
请参考图6,其以三个线段为例进行了具体的描述,步骤S123,可以 包括:
S1231:确定所述测量点云数据中数据点的初始数据点与末尾数据点。
所述初始数据点为所述N个测量线段的第一个端点,所述末尾数据点为 所述N个测量线段的第四个端点。
S1232:在所述测量点云数据中任意取一个参考数据点。
参考数据点,可以为相距所述初始数据点与末尾数据点的连线最远的至 少一个数据点中的其中之一。
图8是本发明一实施例中端点计算的示意图。
请参考图8,针对于测量点云数据S={p1,p2,p3,......pn},可以将点云分割 成3部分,即3条线段ab、bc和cd。其中,很关键的一步就是寻找角点b 和角点c。
如图8所示,点a和点d是已知点,两点形成一条线段,然后计算所 有点云S={p1,p2,p3,......pn}到线段ad的距离,可得到最大距离的数据点m, m点到线段ad的距离满足要求如下:
dmax=max{d1,d2,d3…dn}=dm
可见,m点即为前文所述的参考数据点。
S1233:计算所述参考数据点与所述初始数据点之间各数据点相距第一参 考线的第一间距,并确定所述第一间距为最大值时的数据点为第二个端点; 所述第一参考线为连接所述参考数据点与所述初始数据点形成的。
S1234:计算所述参考数据点与所述末尾数据点之间各数据点相距第二参 考线的第二间距,并确定所述第二间距为最大值时的数据点为第三个端点; 所述第二参考线段为连接所述参考数据点与所述末尾数据点形成的。
可见,结合图8,通过作为参考数据点的m点,可将点云数据 S={p1,p2,p3,......pn}分割成两部分S1={p1,p2,p3,......pm}和 S2={pm+1,pm+2,pm+3,......pn},然后做线段am,其可理解为第一参考线,计算点 云S1={p1,p2,p3,......pm}到线段am的距离,其中距离最大点就是角点b。同理, 作线段dm,其可理解为第二参考点;计算点云S2={pm+1,pm+2,pm+3,......pn}到线 段dm的距离,求的距离最大值就是角点c。
S13:根据所述目标匹配关系,以及标定件位置信息,确定所述激光雷达 的雷达位置信息。
所述标定件位置信息用于表征所述标定件相对于所述车辆的AVG中心 的位置,所述雷达位置信息用于表征所述激光雷达相对于所述AVG中心的位 置。
具体的,通过步骤S12,可以例如得到二维或三维对应的位姿矩阵,即 旋转矩阵R与转移矩阵T。进而,步骤S13中可利用该位姿矩阵表征激光雷 达和标定件的转换关系TCL,其也可理解为一种目标匹配关系;同时,标定 件和AGV之间的转换关系TFC可以通过测量得到,从而最后得到激光雷达 相对AGV位置关系TFL为:TFL=TFC·TCL,其可理解为雷达位置信息。
步骤S12所确定的目标匹配关系的确定过程,以及步骤S13所确定的 雷达位置信息的确定过程中至少之一可以结合高度差。
图9是本发明一实施例中激光雷达位置标定的数据处理装置的模块示意 图。
请参考图9,激光雷达位置标定的数据处理装置200,包括:
获取模块201,用于获取测量点云数据,所述测量点云数据是安装于车 辆的激光雷达扫描安装于所述车辆的标定件而产生的;所述标定件在水平面 的投影与所述车辆在水平面的投影相匹配;所述标定件调整后的高度与所述 激光雷达的高度相匹配;
匹配模块202,用于根据所述测量点云数据与理论点云数据,确定所述 测量点云数据与所述理论点云数据的目标匹配关系;所述目标匹配关系用于 表征所述测量点云数据中数据点与所述理论点云数据中数据点的一种空间坐 标转换的方式,所述测量点云数据与所述理论点云数据是不同坐标系下的;
位置标定模块203,用于根据所述目标匹配关系,以及标定件位置信息, 确定所述激光雷达的雷达位置信息,所述标定件位置信息用于表征所述标定 件相对于所述车辆的AVG中心的位置,所述雷达位置信息用于表征所述激光 雷达相对于所述AVG中心的位置。
可选的,所述激光雷达为3D激光雷达,所述测量点云数据与所述理论 点云数据为三维的点云数据。
可选的,所述匹配模块202,具体用于:
计算所述测量点云数据中的数据点与所述理论点云数据的数据点的残差, 并确定所述残差为最小值时所述测量点云数据与所述理论点云数据间的匹配 关系,并以此为所述目标匹配关系。
可选的,所述激光雷达为2D激光雷达,所述测量点云数据与所述理论 点云数据为二维的点云数据。
可选的,所述匹配模块202,具体用于:
确定所述测量点云数据中数据点所形成的N个测量线段,每个测量线段 对应于一个理论线段,所述理论线段是所述理论点云数据中数据点所形成的; 其中的N为大于或等于1的整数;所述N个测量线段是连续的;
在同一参考平面中,计算各测量线段中各数据点与对应理论线段中各数 据点的距离;并确定所述距离的总和为最小值时所述测量点云数据与所述理 论点云数据间的匹配关系,并以此为所述目标匹配关系。
可选的,N为3,且三个连续的测量线段对应于四个端点;所述匹配模 块202,具体用于:
确定所述测量点云数据中数据点的初始数据点与末尾数据点;所述初始 数据点为所述N个测量线段的第一个端点,所述末尾数据点为所述N个测量 线段的第四个端点;
在所述测量点云数据中任意取一个参考数据点;所述参考数据点为相距 所述初始数据点与末尾数据点的连线最远的至少一个数据点中的其中之一;
计算所述参考数据点与所述初始数据点之间各数据点相距第一参考线的 第一间距,并确定所述第一间距为最大值时的数据点为第二个端点;所述第 一参考线为连接所述参考数据点与所述初始数据点形成的;
计算所述参考数据点与所述末尾数据点之间各数据点相距第二参考线的 第二间距,并确定所述第二间距为最大值时的数据点为第三个端点;所述第 二参考线段为连接所述参考数据点与所述末尾数据点形成的。
请参考图1,本实施还提供了一种激光雷达位置标定系统,包括:安装 于车辆1的标定件3,以及用于实施以上可选方式所涉及的激光雷达位置标 定的数据处理方法的电子设备;所述电子设备为所述激光雷达本身,或者: 所述电子设备与所述激光雷达连接,即以上数据处理方法所涉及的步骤可以 利用激光雷达2来实现,也可通过激光雷达2以外的具有数据处理能力的设 备来实现。
其中一种实施方式中,所述标定件表面可以为白色,其可,表面满足漫 反射要求,白色漫反射表面增加激光反射率,使得观测到的点云更密,噪声 更小。
其中一种实施方式中,所述标定件表面可以粘贴有反光带,从而提高激 光雷达扫描的点云的密度。
图10是本发明一实施例中标定件的结构示意图一;图11是本发明一实 施例中标定件的结构示意图二;图12是本发明一实施例中标定件的结构示意 图三。
请参考图10至图12,标定件3可以包括面板31与装配组件32,该面板 互相垂直,可形成长方体或类长方体的结构形式,该面板31可以是全包围形 成完整长方体的,例如具有六个面板,还可以仅长方体的部分表面具有面板。
该装配组件32可例如铝合金型材、标准连接角材等。
图13是本发明一实施例中激光雷达位置标定方法的流程示意图。
请参考图13,激光雷达位置标定方法,包括:
S31:在车辆的安装激光雷达与标定件。
S32:调整所述标定件在水平面的投影与所述车辆在水平面的投影相匹配。
S33:调整所述标定件调整后的高度与所述激光雷达的高度相匹配。
以上过程可参照步骤S11中对投影相匹配,以及高度相匹配的相关描述 理解。
S34:利用以上可选方案涉及的激光雷达位置标定的数据处理方法确定所 述雷达位置信息。
图14是本发明一实施例中电子设备的结构示意图。
请参考图14,电子设备40,包括存储器42与处理器41。
所述存储器42,用于存储所述处理器41的可执行指令;
所述处理器41配置为经由执行所述可执行指令来执行以上可选方案涉 及的激光雷达位置标定的数据处理方法。
存储器42能够通过总线43与处理器41通讯。
根据本发明的第五方面,提供了一种存储介质,其上存储有计算机程序, 其特征在于,该程序被处理器执行时实现以上可选方案涉及的激光雷达位置 标定的数据处理方法。
综上所述,本发明提供的激光雷达位置标定方法、系统及其数据处理方 法、系统,能够对激光雷达相对于AVG中心的位置进行标定,进而,基于标 定后的位置,在AVG的导引时不会再受到安装时对加工精度、装配容差、人 为操作等因素的影响,有利于避免不当导引的发生,进而,还能使得AVG的 装配加工不再受限于各种加工精度与装配容差的要求,有利于提高装配加工 的效率。
同时,本发明提供的激光雷达位置标定方法、系统及其数据处理方法、 系统中,由于其根据测量点云数据与理论点云数据来确定匹配关系,其可有 利于提高位置标定的精度。
本领域普通技术人员可以理解:实现上述各方法实施例的全部或部分步 骤可以通过程序指令相关的硬件来完成。前述的程序可以存储于一计算机可 读取存储介质中。该程序在执行时,执行包括上述各方法实施例的步骤;而 前述的存储介质包括:ROM、RAM、磁碟或者光盘等各种可以存储程序代码 的介质。
最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对 其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通 技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改, 或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并 不使相应技术方案的本质脱离本发明各实施例技术方案的范围。

Claims (10)

1.一种激光雷达位置标定的数据处理方法,其特征在于,包括:
获取测量点云数据,所述测量点云数据是安装于车辆的激光雷达扫描安装于所述车辆的标定件而产生的;所述标定件在水平面的投影与所述车辆在水平面的投影相匹配;所述标定件调整后的高度与所述激光雷达的高度相匹配;
根据所述测量点云数据与理论点云数据,确定所述测量点云数据与所述理论点云数据的目标匹配关系;所述目标匹配关系用于表征所述测量点云数据中数据点与所述理论点云数据中数据点的一种空间坐标转换的方式,所述测量点云数据与所述理论点云数据是不同坐标系下的;
根据所述目标匹配关系,以及标定件位置信息,确定所述激光雷达的雷达位置信息,所述标定件位置信息用于表征所述标定件相对于所述车辆的AVG中心的位置,所述雷达位置信息用于表征所述激光雷达相对于所述AVG中心的位置。
2.根据权利要求1所述的方法,其特征在于,所述激光雷达为3D激光雷达,所述测量点云数据与所述理论点云数据为三维的点云数据。
3.根据权利要求2所述的方法,其特征在于,所述根据所述测量点云数据与理论点云数据,确定所述测量点云数据与所述理论点云数据的目标匹配关系,包括:
计算所述测量点云数据中的数据点与所述理论点云数据的数据点的残差;
确定所述残差为最小值时所述测量点云数据与所述理论点云数据间的匹配关系,并以此为所述目标匹配关系。
4.根据权利要求1所述的方法,其特征在于,所述激光雷达为2D激光雷达,所述测量点云数据与所述理论点云数据为二维的点云数据。
5.根据权利要求4所述的方法,其特征在于,所述根据所述测量点云数据与理论点云数据,确定所述测量点云数据与所述理论点云数据的目标匹配关系,包括:
确定所述测量点云数据中数据点所形成的N个测量线段,每个测量线段对应于一个理论线段,所述理论线段是所述理论点云数据中数据点所形成的;其中的N为大于或等于1的整数;所述N个测量线段是连续的;
在同一参考平面中,计算各测量线段中各数据点与对应理论线段中各数据点的距离;并确定所述距离的总和为最小值时所述测量点云数据与所述理论点云数据间的匹配关系,并以此为所述目标匹配关系。
6.根据权利要求5所述的方法,其特征在于,N为3,且三个连续的测量线段对应于四个端点;所述确定所述测量点云数据中数据点所形成的N个测量线段,包括:
确定所述测量点云数据中数据点的初始数据点与末尾数据点;所述初始数据点为所述N个测量线段的第一个端点,所述末尾数据点为所述N个测量线段的第四个端点;
在所述测量点云数据中任意取一个参考数据点;所述参考数据点为相距所述初始数据点与末尾数据点的连线最远的至少一个数据点中的其中之一;
计算所述参考数据点与所述初始数据点之间各数据点相距第一参考线的第一间距,并确定所述第一间距为最大值时的数据点为第二个端点;所述第一参考线为连接所述参考数据点与所述初始数据点形成的;
计算所述参考数据点与所述末尾数据点之间各数据点相距第二参考线的第二间距,并确定所述第二间距为最大值时的数据点为第三个端点;所述第二参考线段为连接所述参考数据点与所述末尾数据点形成的。
7.一种激光雷达位置标定的数据处理装置,其特征在于,包括:
获取模块,用于获取测量点云数据,所述测量点云数据是安装于车辆的激光雷达扫描安装于所述车辆的标定件而产生的;所述标定件在水平面的投影与所述车辆在水平面的投影相匹配;所述标定件调整后的高度与所述激光雷达的高度相匹配;
匹配模块,用于根据所述测量点云数据与理论点云数据,确定所述测量点云数据与所述理论点云数据的目标匹配关系;所述目标匹配关系用于表征所述测量点云数据中数据点与所述理论点云数据中数据点的一种空间坐标转换的方式,所述测量点云数据与所述理论点云数据是不同坐标系下的;
位置标定模块,用于根据所述目标匹配关系,以及标定件位置信息,确定所述激光雷达的雷达位置信息,所述标定件位置信息用于表征所述标定件相对于所述车辆的AVG中心的位置,所述雷达位置信息用于表征所述激光雷达相对于所述AVG中心的位置。
8.一种激光雷达位置标定方法,包括:
在车辆的安装激光雷达与标定件;并调整所述标定件在水平面的投影与所述车辆在水平面的投影相匹配,调整所述标定件调整后的高度与所述激光雷达的高度相匹配;
利用权利要求1至6任一项所述的激光雷达位置标定的数据处理方法确定所述雷达位置信息。
9.一种激光雷达位置标定系统,其特征在于,包括:安装于车辆的标定件,以及用于实施权利要求1至6任一项所述的激光雷达位置标定的数据处理方法的电子设备;所述电子设备为所述激光雷达本身,或者:所述电子设备与所述激光雷达连接。
10.根据权利要求9所述的系统,其特征在于,所述标定件表面为白色和/或,所述标定件表面粘贴有反光带。
CN201910163814.XA 2019-03-05 2019-03-05 激光雷达位置标定方法、系统及其数据处理方法、系统 Pending CN110132130A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910163814.XA CN110132130A (zh) 2019-03-05 2019-03-05 激光雷达位置标定方法、系统及其数据处理方法、系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910163814.XA CN110132130A (zh) 2019-03-05 2019-03-05 激光雷达位置标定方法、系统及其数据处理方法、系统

Publications (1)

Publication Number Publication Date
CN110132130A true CN110132130A (zh) 2019-08-16

Family

ID=67568503

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910163814.XA Pending CN110132130A (zh) 2019-03-05 2019-03-05 激光雷达位置标定方法、系统及其数据处理方法、系统

Country Status (1)

Country Link
CN (1) CN110132130A (zh)

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110658503A (zh) * 2019-10-17 2020-01-07 北京百度网讯科技有限公司 用于修正雷达的测量角度的方法及装置
CN110927732A (zh) * 2019-10-21 2020-03-27 上海宾通智能科技有限公司 位姿识别方法、电子设备和存储介质
CN110988848A (zh) * 2019-12-23 2020-04-10 潍柴动力股份有限公司 车载激光雷达相对位姿监测方法及设备
CN111208493A (zh) * 2020-01-08 2020-05-29 同济大学 一种车载激光雷达在整车坐标系下的快速标定方法
CN111289957A (zh) * 2020-03-10 2020-06-16 上海高仙自动化科技发展有限公司 外参标定方法及装置、智能机器人及计算机可读存储介质
CN112327312A (zh) * 2020-10-28 2021-02-05 上海高仙自动化科技发展有限公司 一种车辆位姿确定方法、装置、车辆及存储介质
CN112526486A (zh) * 2020-11-23 2021-03-19 哈尔滨工业大学 一种基于轴系误差模型的三维激光雷达空间坐标校准方法
CN113119791A (zh) * 2021-04-29 2021-07-16 上海宾通智能科技有限公司 一种电池装载机器人、电池管理系统及其控制方法
CN113513988A (zh) * 2021-07-12 2021-10-19 广州小鹏自动驾驶科技有限公司 一种激光雷达标靶检测方法、装置、车辆、存储介质
WO2021232247A1 (zh) * 2020-05-19 2021-11-25 深圳市大疆创新科技有限公司 点云着色方法、点云着色系统和计算机存储介质
WO2023004792A1 (zh) * 2021-07-30 2023-02-02 深圳市速腾聚创科技有限公司 一种激光雷达的姿态标定方法、相关装置、以及存储介质

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20040130702A1 (en) * 2001-02-09 2004-07-08 Jupp David L Lidar system and method
WO2009117161A2 (en) * 2008-03-21 2009-09-24 Variation Reduction Solutions, Inc. External system for robotic accuracy enhancement
CN106643805A (zh) * 2016-12-30 2017-05-10 上海交通大学 激光定位传感器在agv小车中位置标定方法
CN106872963A (zh) * 2017-03-31 2017-06-20 厦门大学 一种多组多线激光雷达的自动标定算法
CN106885531A (zh) * 2017-04-20 2017-06-23 河北科技大学 基于二维激光雷达的车斗形容器三维扫描系统标定方法
CN107179534A (zh) * 2017-06-29 2017-09-19 北京北科天绘科技有限公司 一种激光雷达参数自动标定的方法、装置及激光雷达
CN107239076A (zh) * 2017-06-28 2017-10-10 仲训昱 基于虚拟扫描与测距匹配的agv激光slam方法
CN108226938A (zh) * 2017-12-08 2018-06-29 华南理工大学 一种agv小车的定位系统和方法
CN108399643A (zh) * 2018-03-15 2018-08-14 南京大学 一种激光雷达和相机间的外参标定系统和方法
CN109084738A (zh) * 2018-07-06 2018-12-25 上海宾通智能科技有限公司 一种可调节高度的标定系统及标定方法
CN109085561A (zh) * 2018-07-08 2018-12-25 河北数冶科技有限公司 三维激光雷达测量系统及标定方法

Patent Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20040130702A1 (en) * 2001-02-09 2004-07-08 Jupp David L Lidar system and method
WO2009117161A2 (en) * 2008-03-21 2009-09-24 Variation Reduction Solutions, Inc. External system for robotic accuracy enhancement
CN106643805A (zh) * 2016-12-30 2017-05-10 上海交通大学 激光定位传感器在agv小车中位置标定方法
CN106872963A (zh) * 2017-03-31 2017-06-20 厦门大学 一种多组多线激光雷达的自动标定算法
CN106885531A (zh) * 2017-04-20 2017-06-23 河北科技大学 基于二维激光雷达的车斗形容器三维扫描系统标定方法
CN107239076A (zh) * 2017-06-28 2017-10-10 仲训昱 基于虚拟扫描与测距匹配的agv激光slam方法
CN107179534A (zh) * 2017-06-29 2017-09-19 北京北科天绘科技有限公司 一种激光雷达参数自动标定的方法、装置及激光雷达
CN108226938A (zh) * 2017-12-08 2018-06-29 华南理工大学 一种agv小车的定位系统和方法
CN108399643A (zh) * 2018-03-15 2018-08-14 南京大学 一种激光雷达和相机间的外参标定系统和方法
CN109084738A (zh) * 2018-07-06 2018-12-25 上海宾通智能科技有限公司 一种可调节高度的标定系统及标定方法
CN109085561A (zh) * 2018-07-08 2018-12-25 河北数冶科技有限公司 三维激光雷达测量系统及标定方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
DE HAAG, MU 等: "Use of 3D laser radar for navigation of unmanned aerial and ground vehicles in urban and indoor environments", 《LASER RADAR TECHNOLOGY AND APPLICATIONS XII》 *
王金旺等: "基于工作空间测量定位系统和激光雷达的室内组合导航算法研究", 《激光与光电子学进展》 *
赵会宾: "基于点云融合的立体导航技术研究", 《中国优秀硕士学位论文库》 *

Cited By (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110658503A (zh) * 2019-10-17 2020-01-07 北京百度网讯科技有限公司 用于修正雷达的测量角度的方法及装置
CN110658503B (zh) * 2019-10-17 2022-03-01 北京百度网讯科技有限公司 用于修正雷达的测量角度的方法及装置
CN110927732A (zh) * 2019-10-21 2020-03-27 上海宾通智能科技有限公司 位姿识别方法、电子设备和存储介质
CN110988848A (zh) * 2019-12-23 2020-04-10 潍柴动力股份有限公司 车载激光雷达相对位姿监测方法及设备
CN111208493A (zh) * 2020-01-08 2020-05-29 同济大学 一种车载激光雷达在整车坐标系下的快速标定方法
CN111289957A (zh) * 2020-03-10 2020-06-16 上海高仙自动化科技发展有限公司 外参标定方法及装置、智能机器人及计算机可读存储介质
CN111289957B (zh) * 2020-03-10 2022-08-16 上海高仙自动化科技发展有限公司 外参标定方法及装置、智能机器人及计算机可读存储介质
CN114026410A (zh) * 2020-05-19 2022-02-08 深圳市大疆创新科技有限公司 点云着色方法、点云着色系统和计算机存储介质
WO2021232247A1 (zh) * 2020-05-19 2021-11-25 深圳市大疆创新科技有限公司 点云着色方法、点云着色系统和计算机存储介质
CN112327312A (zh) * 2020-10-28 2021-02-05 上海高仙自动化科技发展有限公司 一种车辆位姿确定方法、装置、车辆及存储介质
CN112526486B (zh) * 2020-11-23 2022-06-14 哈尔滨工业大学 一种基于轴系误差模型的三维激光雷达空间坐标校准方法
CN112526486A (zh) * 2020-11-23 2021-03-19 哈尔滨工业大学 一种基于轴系误差模型的三维激光雷达空间坐标校准方法
CN113119791A (zh) * 2021-04-29 2021-07-16 上海宾通智能科技有限公司 一种电池装载机器人、电池管理系统及其控制方法
CN113119791B (zh) * 2021-04-29 2022-07-15 上海宾通智能科技有限公司 一种电池装载机器人、电池管理系统及其控制方法
CN113513988A (zh) * 2021-07-12 2021-10-19 广州小鹏自动驾驶科技有限公司 一种激光雷达标靶检测方法、装置、车辆、存储介质
CN113513988B (zh) * 2021-07-12 2023-03-31 广州小鹏自动驾驶科技有限公司 一种激光雷达标靶检测方法、装置、车辆、存储介质
WO2023004792A1 (zh) * 2021-07-30 2023-02-02 深圳市速腾聚创科技有限公司 一种激光雷达的姿态标定方法、相关装置、以及存储介质

Similar Documents

Publication Publication Date Title
CN110132130A (zh) 激光雷达位置标定方法、系统及其数据处理方法、系统
JP7045816B2 (ja) 検査ステーションに配置された車両の最外寸法を測定するための方法及びシステム
RU2731042C2 (ru) Способ для присоединения крыла к корпусу (варианты)
WO2018181974A1 (ja) 判定装置、判定方法、及び、プログラム
WO2018221453A1 (ja) 出力装置、制御方法、プログラム及び記憶媒体
US8363979B2 (en) Method for ascertaining the axis of rotation of a vehicle wheel
JP6557896B2 (ja) レーダ軸ずれ量算出装置およびレーダ軸ずれ量算出方法
CN110837814A (zh) 车辆导航方法、装置及计算机可读存储介质
US11474243B2 (en) Self-calibrating sensor system for a wheeled vehicle
JP7275636B2 (ja) 無人搬送システム及び無人搬送車の自己位置推定方法
EP3763597B1 (en) Train position estimation device
CN113267180B (zh) 一种基于3d深度视觉的agv叉车托盘定位及叉取方法
CN110764110A (zh) 路径导航方法、装置及计算机可读存储介质
CN111913169A (zh) 激光雷达内参、点云数据的修正方法、设备及存储介质
EP3550326A1 (en) Calibration of a sensor arrangement
CN113227821B (zh) 对机动车的环境传感器的定位测量的分析评价
CN112731451A (zh) 一种基于激光雷达检测地面障碍物的方法及系统
KR20210041969A (ko) 지도 매칭을 이용한 온라인 카메라 캘리브레이션 장치 및 방법
CN115963510A (zh) 一种基于激光点云的物流园区车辆精准停车方法和系统
CN113654530B (zh) 一种基于激光传感器的末端定位方法
CN113807442B (zh) 一种目标形状及航向估计方法及系统
CN114228411A (zh) 连接控制方法、装置、设备及存储介质
JP7543244B2 (ja) 位置検出装置及び位置検出方法
CN115097426B (zh) 车载激光雷达更换后的自动标定方法、存储介质及车辆
US20240210539A1 (en) Method and Device for Recognizing a Decalibration of a Lidar System

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
WD01 Invention patent application deemed withdrawn after publication

Application publication date: 20190816

WD01 Invention patent application deemed withdrawn after publication