CN111722202A - 一种基于回波强度的反光板位置拟合方法及系统 - Google Patents

一种基于回波强度的反光板位置拟合方法及系统 Download PDF

Info

Publication number
CN111722202A
CN111722202A CN202010776896.8A CN202010776896A CN111722202A CN 111722202 A CN111722202 A CN 111722202A CN 202010776896 A CN202010776896 A CN 202010776896A CN 111722202 A CN111722202 A CN 111722202A
Authority
CN
China
Prior art keywords
scanning
scanning point
echo intensity
data set
reflector
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.)
Granted
Application number
CN202010776896.8A
Other languages
English (en)
Other versions
CN111722202B (zh
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.)
Hubei University of Technology
Original Assignee
Hubei University of Technology
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 Hubei University of Technology filed Critical Hubei University of Technology
Priority to CN202010776896.8A priority Critical patent/CN111722202B/zh
Publication of CN111722202A publication Critical patent/CN111722202A/zh
Application granted granted Critical
Publication of CN111722202B publication Critical patent/CN111722202B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/48Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
    • G01S7/4802Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00 using analysis of echo signal for target characterisation; Target signature; Target cross-section

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Optical Radar Systems And Details Thereof (AREA)

Abstract

本发明提供了一种基于回波强度的反光板位置拟合方法及系统,方法包括:根据激光雷达数据集确定防畸变数据集和回波强度阈值;判断防畸变数据集中各扫描点反馈的实际回波强度是否大于回波强度阈值;如果防畸变数据集中各扫描点反馈的实际回波强度大于回波强度阈值,则对各扫描点进行聚类分组,获得分组数据集;如果防畸变数据集中各扫描点反馈的实际回波强度小于或等于回波强度阈值,则舍弃各扫描点;对分组数据集进行降噪处理,得到降噪数据集;确定各组降噪数据中各扫描点对应的反光板极坐标和各反光板拟合位置。本发明结合回波强度值能够避免由于激光雷达角分辨率低而产生分布不均匀现象,理论上可以达到比几何函数法更精确的反光板位置拟合。

Description

一种基于回波强度的反光板位置拟合方法及系统
技术领域
本发明涉及反光板位置拟合技术领域,特别是涉及一种基于回波强度的反光板位置拟合方法及系统。
背景技术
近年来随着科学技术的进步和科技水平的提高,各行各业对移动机器人的需求与日俱增。在工厂的日常生产中需要高定位精度、高抗干扰能力的移动机器人,基于反光板的定位方式相对于基于环境特征的定位方式具有更高精度和更高抗干扰性。对反光板进行拟合通常使用最小二乘法、霍夫变换或几何函数等方法。最小二乘法、霍夫变换重复定位精度不如几何函数法,易产生较大的波动,单一的几何函数拟合法由于扫描点的分布不均匀而产生误差。
发明内容
基于此,本发明的目的是提供一种基于回波强度的反光板位置拟合方法及系统,以提高确定反光板位置的精度。
为实现上述目的,本发明提供了一种基于回波强度的反光板位置拟合方法,所述方法包括:
步骤S1:通过数据接口获取激光雷达数据集;所述激光雷达数据集包括多个扫描点实际扫描数据信息,所述扫描点实际扫描数据信息包括:扫描点到扫描中心的距离、扫描点反馈的实际回波强度和扫描角度值;
步骤S2:根据所述激光雷达数据集确定防畸变数据集和回波强度阈值;
步骤S3:判断防畸变数据集中各扫描点反馈的实际回波强度是否大于回波强度阈值;如果防畸变数据集中各扫描点反馈的实际回波强度大于回波强度阈值,则对各扫描点进行聚类分组,获得分组数据集;如果防畸变数据集中各扫描点反馈的实际回波强度小于或等于回波强度阈值,则舍弃各扫描点;
步骤S4:对所述分组数据集进行降噪处理,得到降噪数据集;所述降噪数据集包括多组降噪数据,每组降噪数据包括各扫描点对应的扫描角度值、各扫描点反馈的实际回波强度和防畸变处理后各扫描点到扫描中心的距离;
步骤S5:确定各组降噪数据中各扫描点对应的反光板极坐标;
步骤S6:基于各组降噪数据中各扫描点对应的反光板极坐标确定各反光板拟合位置。
可选地,根据所述激光雷达数据集确定防畸变数据集和回波强度阈值,具体包括:
步骤S21:对所述激光雷达数据集中的各扫描点到扫描中心的距离进行运动学防畸变处理,获得防畸变数据集;所述防畸变数据集包括多个扫描点经过防畸变处理后获得的实际扫描数据信息;各扫描点经过防畸变处理后获得的实际扫描数据信息包括:防畸变处理后扫描点到扫描中心的距离、扫描点反馈的实际回波强度和扫描角度值;
步骤S22:根据防畸变处理后扫描点到扫描中心的距离计算回波强度阈值。
可选地,所述确定各组降噪数据中各扫描点对应的反光板极坐标,具体包括:
步骤S51:确定每组降噪数据中各扫描点到反光板距离值;
步骤S52:根据每组降噪数据中各扫描点到反光板距离值和各扫描点反馈的实际回波强度确定每组降噪数据中各扫描点对应的入射角;
步骤S53:确定各组降噪数据中各扫描点对应的反光板极坐标,所述反光板极坐标包括:弧度值和距离值。
可选地,所述确定各组降噪数据中各扫描点对应的反光板极坐标,具体公式为:
Figure BDA0002618761580000021
其中,D表示各扫描点对应的反光板极坐标的距离值,lscan_B表示防畸变处理后扫描点到扫描中心的距离,r表示反光板半径,β表示光斑中心对应曲面入射角度,Δtheta表示入射点与反光板圆心以激光雷达中心为顶点的角度,θscan表示扫描角度值,θ表示扫描点对应的反光板极坐标的弧度值。
可选地,根据防畸变处理后扫描点到扫描中心的距离计算回波强度阈值,具体公式为:
Figure BDA0002618761580000031
其中,λthreshold表示回波强度阈值,lscan_B表示防畸变处理后扫描点到扫描中心的距离,α1、α2以及α3均为根据反光板材质和现场环境调节的参数。
本发明还提供一种基于回波强度的反光板位置拟合系统,所述系统包括:
获取模块,用于通过数据接口获取激光雷达数据集;所述激光雷达数据集包括多个扫描点实际扫描数据信息,所述扫描点实际扫描数据信息包括:扫描点到扫描中心的距离、扫描点反馈的实际回波强度和扫描角度值;
参数确定模块,用于根据所述激光雷达数据集确定防畸变数据集和回波强度阈值;
判断模块,用于判断防畸变数据集中各扫描点反馈的实际回波强度是否大于回波强度阈值;如果防畸变数据集中各扫描点反馈的实际回波强度大于回波强度阈值,则对各扫描点进行聚类分组,获得分组数据集;如果防畸变数据集中各扫描点反馈的实际回波强度小于或等于回波强度阈值,则舍弃各扫描点;
降噪处理模块,用于对所述分组数据集进行降噪处理,得到降噪数据集;所述降噪数据集包括多组降噪数据,每组降噪数据包括扫描角度值、各扫描点反馈的实际回波强度和防畸变处理后各扫描点到扫描中心的距离;
反光板极坐标确定模块,用于确定各组降噪数据中各扫描点对应的反光板极坐标;
各反光板拟合位置确定模块,基于各组降噪数据中各扫描点对应的反光板极坐标确定各反光板拟合位置。
可选地,参数确定模块,具体包括:
防畸变数据集确定单元,用于对所述激光雷达数据集中的各扫描点到扫描中心的距离进行运动学防畸变处理,获得防畸变数据集;所述防畸变数据集包括多个扫描点经过防畸变处理后获得的实际扫描数据信息;各扫描点经过防畸变处理后获得的实际扫描数据信息包括:防畸变处理后扫描点到扫描中心的距离、扫描点反馈的实际回波强度和扫描角度值;
回波强度阈值确定单元,用于根据防畸变处理后扫描点到扫描中心的距离计算回波强度阈值。
可选地,所述反光板极坐标确定模块,具体包括:
反光板距离值确定单元,用于确定每组降噪数据中各扫描点到反光板距离值;
入射角确定单元,用于根据每组降噪数据中各扫描点到反光板距离值和各扫描点反馈的实际回波强度确定每组降噪数据中各扫描点对应的入射角;
反光板极坐标确定单元,用于确定各组降噪数据中各扫描点对应的反光板极坐标,所述反光板极坐标包括:弧度值和距离值。
可选地,所述确定各组降噪数据中各扫描点对应的反光板极坐标,具体公式为:
Figure BDA0002618761580000041
其中,D表示各扫描点对应的反光板极坐标的距离值,lscan_B表示防畸变处理后扫描点到扫描中心的距离,r表示反光板半径,β表示光斑中心对应曲面入射角度,Δtheta表示入射点与反光板圆心以激光雷达中心为顶点的角度,θscan表示扫描角度值,θ表示各扫描点对应的反光板极坐标的弧度值。
可选地,根据防畸变处理后扫描点到扫描中心的距离计算回波强度阈值,具体公式为:
Figure BDA0002618761580000042
其中,λthreshold表示回波强度阈值,lscan_B表示防畸变处理后扫描点到扫描中心的距离,α1、α2以及α3均为根据反光板材质和现场环境调节的参数。
根据本发明提供的具体实施例,本发明公开了以下技术效果:
本发明提供了一种基于回波强度的反光板位置拟合方法及系统,方法包括:根据激光雷达数据集确定防畸变数据集和回波强度阈值;判断防畸变数据集中各扫描点反馈的实际回波强度是否大于回波强度阈值;如果防畸变数据集中各扫描点反馈的实际回波强度大于回波强度阈值,则对各扫描点进行聚类分组,获得分组数据集;如果防畸变数据集中各扫描点反馈的实际回波强度小于或等于回波强度阈值,则舍弃各扫描点;对分组数据集进行降噪处理,得到降噪数据集;确定各组降噪数据中各扫描点对应的反光板极坐标和各反光板拟合位置。本发明结合回波强度值能够避免由于激光雷达角分辨率低而产生分布不均匀现象,理论上可以达到比几何函数法更精确的反光板位置拟合。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明实施例基于回波强度的反光板位置拟合方法流程图
图2为本发明实施例基于回波强度的反光板位置拟合系统结构图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明的目的是提供一种基于回波强度的反光板位置拟合方法及系统,以提高确定反光板位置的精度。
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图和具体实施方式对本发明作进一步详细的说明。
如图1所示,本发明提供了一种基于回波强度的反光板位置拟合方法,所述方法包括:
步骤S1:通过数据接口获取激光雷达数据集;所述激光雷达数据集包括多个扫描点实际扫描数据信息,所述扫描点实际扫描数据信息包括:扫描点到扫描中心的距离、扫描点反馈的实际回波强度和扫描角度值。
步骤S2:根据所述激光雷达数据集确定防畸变数据集和回波强度阈值。
步骤S3:判断防畸变数据集中各扫描点反馈的实际回波强度是否大于回波强度阈值;如果防畸变数据集中各扫描点反馈的实际回波强度大于回波强度阈值,则对各扫描点进行聚类分组,获得分组数据集;如果防畸变数据集中各扫描点反馈的实际回波强度小于或等于回波强度阈值,则舍弃各扫描点。
步骤S4:对所述分组数据集进行降噪处理,得到降噪数据集;所述降噪数据集包括多组降噪数据,每组降噪数据包括各扫描点对应的扫描角度值、各扫描点反馈的实际回波强度和防畸变处理后各扫描点到扫描中心的距离。
步骤S5:确定各组降噪数据中各扫描点对应的反光板极坐标。
步骤S6:基于各组降噪数据中各扫描点对应的反光板极坐标确定各反光板拟合位置。
下面对各个步骤进行详细论述:
步骤S1:通过数据接口获取激光雷达数据集A{Scandatapointi};所述激光雷达数据集包括多个扫描点实际扫描数据信息,所述扫描点实际扫描数据信息包括:扫描点到扫描中心的距离lscan_A、扫描点反馈的实际回波强度λ和扫描角度值θscan。所述扫描点的个数是由激光雷达的型号决定的,本实施例中扫描点的个数为7200个。
步骤S2:根据所述激光雷达数据集确定防畸变数据集和回波强度阈值,具体包括:
步骤S21:对所述激光雷达数据集中的各扫描点到扫描中心的距离进行运动学防畸变处理,获得防畸变数据集B{Scandatapoint Reali},具体公式为:
lscan_B=f(lscan_A,vtt);
其中,vt表示实际速度(m/s),wt表示角速度(rad/s),lscan_A表示扫描点到扫描中心的距离Scandatapointi,lscan_B表示防畸变处理后扫描点到扫描中心的距离。
防畸变数据集B{Scandatapoint Reali}中扫描点的个数与A{Scandatapointi}扫描点的个数相同;所述防畸变数据集包括多个扫描点经过防畸变处理后获得的实际扫描数据信息;各扫描点经过防畸变处理后获得的实际扫描数据信息包括:防畸变处理后扫描点到扫描中心的距离lscan_B、扫描点反馈的实际回波强度λ和扫描角度值θscan
步骤S22:根据防畸变处理后扫描点到扫描中心的距离计算回波强度阈值,具体公式为:
Figure BDA0002618761580000071
其中,λthreshold表示回波强度阈值,lscan_B表示防畸变处理后扫描点到扫描中心的距离,α1、α2以及α3均为根据反光板材质和现场环境调节的参数。
步骤S3:判断防畸变数据集中各扫描点反馈的实际回波强度是否大于回波强度阈值;如果防畸变数据集中各扫描点反馈的实际回波强度大于回波强度阈值,则对各扫描点进行聚类分组,获得分组数据集;如果防畸变数据集中各扫描点反馈的实际回波强度小于或等于回波强度阈值,则舍弃各扫描点。
步骤S4:对所述分组数据集进行降噪处理,得到降噪数据集;所述降噪数据集包括多组降噪数据,每组降噪数据包括各扫描点对应的扫描角度值、各扫描点反馈的实际回波强度和防畸变处理后各扫描点到扫描中心的距离;具体的,通过已知的反光板半径以及环境中高亮噪声点对分组数据集进行降噪处理,剔除过多或过少的点组,获得降噪数据集C{Point_groupk},Point_groupk={ScandatapointReali...ScandatapointRealm},i至m均属于同一反光板的特征点。
步骤S5:确定各组降噪数据中各扫描点对应的反光板极坐标,具体包括:
步骤S51:确定每组降噪数据中各扫描点到反光板距离值d。
步骤S52:根据每组降噪数据中各扫描点到反光板距离值d和各扫描点反馈的实际回波强度λ确定每组降噪数据中各扫描点对应的入射角β,具体公式为:
λ=f(d,β);
其中,β表示每组降噪数据中各扫描点对应的入射角,d表示每组降噪数据中各扫描点到反光板距离值,λ表示各扫描点反馈的实际回波强度,f(·)表示拟合函数。
步骤S53:确定各组降噪数据中各扫描点对应的反光板极坐标,所述反光板极坐标包括:弧度值和距离值;具体公式为:
Figure BDA0002618761580000081
其中,D表示各扫描点对应的反光板极坐标的距离值,lscan_B表示防畸变处理后扫描点到扫描中心的距离,r表示反光板半径,β表示光斑中心对应曲面入射角度,Δtheta表示入射点与反光板圆心以激光雷达中心为顶点的角度,θscan表示扫描角度值,θ表示各扫描点对应的反光板极坐标的弧度值,(D,θ)表示各扫描点对应的反光板极坐标。
步骤S6:基于各组降噪数据中各扫描点对应的反光板极坐标确定各反光板拟合位置;具体的,将每组降噪数据中各扫描点对应的反光板极坐标相加求平均,获得各组降噪数据对应的反光板极坐标,第j组降噪数据对应的反光板极坐标即为第j个反光板拟合位置,1≤j≤k,k表示降噪数据的总组数。
如图2所示,本发明还提供一种基于回波强度的反光板位置拟合系统,所述系统包括:
获取模块1,用于通过数据接口获取激光雷达数据集;所述激光雷达数据集包括多个扫描点实际扫描数据信息,所述扫描点实际扫描数据信息包括:扫描点到扫描中心的距离、扫描点反馈的实际回波强度和扫描角度值。
参数确定模块2,用于根据所述激光雷达数据集确定防畸变数据集和回波强度阈值。
判断模块3,用于判断防畸变数据集中各扫描点反馈的实际回波强度是否大于回波强度阈值;如果防畸变数据集中各扫描点反馈的实际回波强度大于回波强度阈值,则对各扫描点进行聚类分组,获得分组数据集;如果防畸变数据集中各扫描点反馈的实际回波强度小于或等于回波强度阈值,则舍弃各扫描点。
降噪处理模块4,用于对所述分组数据集进行降噪处理,得到降噪数据集;所述降噪数据集包括多组降噪数据,每组降噪数据包括扫描角度值、各扫描点反馈的实际回波强度和防畸变处理后各扫描点到扫描中心的距离。
反光板极坐标确定模块5,用于确定各组降噪数据中各扫描点对应的反光板极坐标。
各反光板拟合位置确定模块6,基于各组降噪数据中各扫描点对应的反光板极坐标确定各反光板拟合位置。
下面对各个模块进行详细论述:
参数确定模块2,具体包括:
防畸变数据集确定单元,用于对所述激光雷达数据集中的各扫描点到扫描中心的距离进行运动学防畸变处理,获得防畸变数据集;所述防畸变数据集包括多个扫描点经过防畸变处理后获得的实际扫描数据信息;各扫描点经过防畸变处理后获得的实际扫描数据信息包括:防畸变处理后扫描点到扫描中心的距离、扫描点反馈的实际回波强度和扫描角度值;
回波强度阈值确定单元,用于根据防畸变处理后扫描点到扫描中心的距离计算回波强度阈值,具体公式为:
Figure BDA0002618761580000091
其中,λthreshold表示回波强度阈值,lscan_B表示防畸变处理后扫描点到扫描中心的距离,α1、α2以及α3均为根据反光板材质和现场环境调节的参数。
所述反光板极坐标确定模块5,具体包括:
反光板距离值确定单元,用于确定每组降噪数据中各扫描点到反光板距离值;
入射角确定单元,用于根据每组降噪数据中各扫描点到反光板距离值和各扫描点反馈的实际回波强度确定每组降噪数据中各扫描点对应的入射角;
反光板极坐标确定单元,用于确定各组降噪数据中各扫描点对应的反光板极坐标,所述反光板极坐标包括:弧度值和距离值。
所述确定各组降噪数据中各扫描点对应的反光板极坐标,具体公式为:
Figure BDA0002618761580000101
其中,D表示各扫描点对应的反光板极坐标的距离值,lscan_B表示防畸变处理后扫描点到扫描中心的距离,r表示反光板半径,β表示光斑中心对应曲面入射角度,Δtheta表示入射点与反光板圆心以激光雷达中心为顶点的角度,θscan表示扫描角度值,θ表示各扫描点对应的反光板极坐标的弧度值。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。
本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处。综上所述,本说明书内容不应理解为对本发明的限制。

Claims (10)

1.一种基于回波强度的反光板位置拟合方法,其特征在于,所述方法包括:
步骤S1:通过数据接口获取激光雷达数据集;所述激光雷达数据集包括多个扫描点实际扫描数据信息,所述扫描点实际扫描数据信息包括:扫描点到扫描中心的距离、扫描点反馈的实际回波强度和扫描角度值;
步骤S2:根据所述激光雷达数据集确定防畸变数据集和回波强度阈值;
步骤S3:判断防畸变数据集中各扫描点反馈的实际回波强度是否大于回波强度阈值;如果防畸变数据集中各扫描点反馈的实际回波强度大于回波强度阈值,则对各扫描点进行聚类分组,获得分组数据集;如果防畸变数据集中各扫描点反馈的实际回波强度小于或等于回波强度阈值,则舍弃各扫描点;
步骤S4:对所述分组数据集进行降噪处理,得到降噪数据集;所述降噪数据集包括多组降噪数据,每组降噪数据包括各扫描点对应的扫描角度值、各扫描点反馈的实际回波强度和防畸变处理后各扫描点到扫描中心的距离;
步骤S5:确定各组降噪数据中各扫描点对应的反光板极坐标;
步骤S6:基于各组降噪数据中各扫描点对应的反光板极坐标确定各反光板拟合位置。
2.根据权利要求1所述的基于回波强度的反光板位置拟合方法,其特征在于,根据所述激光雷达数据集确定防畸变数据集和回波强度阈值,具体包括:
步骤S21:对所述激光雷达数据集中的各扫描点到扫描中心的距离进行运动学防畸变处理,获得防畸变数据集;所述防畸变数据集包括多个扫描点经过防畸变处理后获得的实际扫描数据信息;各扫描点经过防畸变处理后获得的实际扫描数据信息包括:防畸变处理后扫描点到扫描中心的距离、扫描点反馈的实际回波强度和扫描角度值;
步骤S22:根据防畸变处理后扫描点到扫描中心的距离计算回波强度阈值。
3.根据权利要求1所述的基于回波强度的反光板位置拟合方法,其特征在于,所述确定各组降噪数据中各扫描点对应的反光板极坐标,具体包括:
步骤S51:确定每组降噪数据中各扫描点到反光板距离值;
步骤S52:根据每组降噪数据中各扫描点到反光板距离值和各扫描点反馈的实际回波强度确定每组降噪数据中各扫描点对应的入射角;
步骤S53:确定各组降噪数据中各扫描点对应的反光板极坐标,所述反光板极坐标包括:弧度值和距离值。
4.根据权利要求3所述的基于回波强度的反光板位置拟合方法,其特征在于,所述确定各组降噪数据中各扫描点对应的反光板极坐标,具体公式为:
Figure FDA0002618761570000021
其中,D表示各扫描点对应的反光板极坐标的距离值,lscan_B表示防畸变处理后扫描点到扫描中心的距离,r表示反光板半径,β表示光斑中心对应曲面入射角度,Δtheta表示入射点与反光板圆心以激光雷达中心为顶点的角度,θscan表示扫描角度值,θ表示扫描点对应的反光板极坐标的弧度值。
5.根据权利要求2所述的基于回波强度的反光板位置拟合方法,其特征在于,所述根据防畸变处理后扫描点到扫描中心的距离计算回波强度阈值,具体公式为:
Figure FDA0002618761570000022
其中,λthreshold表示回波强度阈值,lscan_B表示防畸变处理后扫描点到扫描中心的距离,α1、α2以及α3均为根据反光板材质和现场环境调节的参数。
6.一种基于回波强度的反光板位置拟合系统,其特征在于,所述系统包括:
获取模块,用于通过数据接口获取激光雷达数据集;所述激光雷达数据集包括多个扫描点实际扫描数据信息,所述扫描点实际扫描数据信息包括:扫描点到扫描中心的距离、扫描点反馈的实际回波强度和扫描角度值;
参数确定模块,用于根据所述激光雷达数据集确定防畸变数据集和回波强度阈值;
判断模块,用于判断防畸变数据集中各扫描点反馈的实际回波强度是否大于回波强度阈值;如果防畸变数据集中各扫描点反馈的实际回波强度大于回波强度阈值,则对各扫描点进行聚类分组,获得分组数据集;如果防畸变数据集中各扫描点反馈的实际回波强度小于或等于回波强度阈值,则舍弃各扫描点;
降噪处理模块,用于对所述分组数据集进行降噪处理,得到降噪数据集;所述降噪数据集包括多组降噪数据,每组降噪数据包括扫描角度值、各扫描点反馈的实际回波强度和防畸变处理后各扫描点到扫描中心的距离;
反光板极坐标确定模块,用于确定各组降噪数据中各扫描点对应的反光板极坐标;
各反光板拟合位置确定模块,基于各组降噪数据中各扫描点对应的反光板极坐标确定各反光板拟合位置。
7.根据权利要求6所述的基于回波强度的反光板位置拟合系统,其特征在于,参数确定模块,具体包括:
防畸变数据集确定单元,用于对所述激光雷达数据集中的各扫描点到扫描中心的距离进行运动学防畸变处理,获得防畸变数据集;所述防畸变数据集包括多个扫描点经过防畸变处理后获得的实际扫描数据信息;各扫描点经过防畸变处理后获得的实际扫描数据信息包括:防畸变处理后扫描点到扫描中心的距离、扫描点反馈的实际回波强度和扫描角度值;
回波强度阈值确定单元,用于根据防畸变处理后扫描点到扫描中心的距离计算回波强度阈值。
8.根据权利要求6所述的基于回波强度的反光板位置拟合系统,其特征在于,所述反光板极坐标确定模块,具体包括:
反光板距离值确定单元,用于确定每组降噪数据中各扫描点到反光板距离值;
入射角确定单元,用于根据每组降噪数据中各扫描点到反光板距离值和各扫描点反馈的实际回波强度确定每组降噪数据中各扫描点对应的入射角;
反光板极坐标确定单元,用于确定各组降噪数据中各扫描点对应的反光板极坐标,所述反光板极坐标包括:弧度值和距离值。
9.根据权利要求8所述的基于回波强度的反光板位置拟合系统,其特征在于,所述确定各组降噪数据中各扫描点对应的反光板极坐标,具体公式为:
Figure FDA0002618761570000041
其中,D表示各扫描点对应的反光板极坐标的距离值,lscan_B表示防畸变处理后扫描点到扫描中心的距离,r表示反光板半径,β表示光斑中心对应曲面入射角度,Δtheta表示入射点与反光板圆心以激光雷达中心为顶点的角度,θscan表示扫描角度值,θ表示各扫描点对应的反光板极坐标的弧度值。
10.根据权利要求7所述的基于回波强度的反光板位置拟合系统,其特征在于,所述根据防畸变处理后扫描点到扫描中心的距离计算回波强度阈值,具体公式为:
Figure FDA0002618761570000042
其中,λthreshold表示回波强度阈值,lscan_B表示防畸变处理后扫描点到扫描中心的距离,α1、α2以及α3均为根据反光板材质和现场环境调节的参数。
CN202010776896.8A 2020-08-05 2020-08-05 一种基于回波强度的反光板位置拟合方法及系统 Active CN111722202B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010776896.8A CN111722202B (zh) 2020-08-05 2020-08-05 一种基于回波强度的反光板位置拟合方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010776896.8A CN111722202B (zh) 2020-08-05 2020-08-05 一种基于回波强度的反光板位置拟合方法及系统

Publications (2)

Publication Number Publication Date
CN111722202A true CN111722202A (zh) 2020-09-29
CN111722202B CN111722202B (zh) 2021-04-27

Family

ID=72574439

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010776896.8A Active CN111722202B (zh) 2020-08-05 2020-08-05 一种基于回波强度的反光板位置拟合方法及系统

Country Status (1)

Country Link
CN (1) CN111722202B (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112305520A (zh) * 2020-10-27 2021-02-02 三一机器人科技有限公司 单激光雷达的反光柱检测位置的修正方法和装置
CN115220012A (zh) * 2022-09-20 2022-10-21 成都睿芯行科技有限公司 一种基于反光板定位方法
CN115616525A (zh) * 2022-12-06 2023-01-17 深圳煜炜光学科技有限公司 反射回波信号分辨方法、装置、设备及存储介质

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0001393A2 (en) * 1977-08-25 1979-04-18 Charles R. Henry A system for the distribution, transmission, detection, collection or modulation of propagating energy and/or energy fields
US20040208220A1 (en) * 2003-04-15 2004-10-21 Gmachl Claire F. Optical resonators that include chaotic ray paths
CN102354363A (zh) * 2011-09-15 2012-02-15 西北工业大学 高反光柱面金属上的二维条码图像识别方法
CN106447715A (zh) * 2016-01-29 2017-02-22 北京建筑大学 用于激光雷达的平面反射标靶中心点位置提取方法
CN107102641A (zh) * 2017-05-18 2017-08-29 湖北工业大学 一种基于激光引导双轮差速agv的原地偏航旋转方法
CN107390227A (zh) * 2017-07-13 2017-11-24 浙江科钛机器人股份有限公司 一种基于数据筛选的双反光板激光定位与导航方法
CN109104153A (zh) * 2018-09-07 2018-12-28 广东工业大学 一种反射式聚光系统
CN109633681A (zh) * 2018-12-05 2019-04-16 芜湖智久机器人有限公司 一种反光板识别方法及装置

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0001393A2 (en) * 1977-08-25 1979-04-18 Charles R. Henry A system for the distribution, transmission, detection, collection or modulation of propagating energy and/or energy fields
US20040208220A1 (en) * 2003-04-15 2004-10-21 Gmachl Claire F. Optical resonators that include chaotic ray paths
CN102354363A (zh) * 2011-09-15 2012-02-15 西北工业大学 高反光柱面金属上的二维条码图像识别方法
CN106447715A (zh) * 2016-01-29 2017-02-22 北京建筑大学 用于激光雷达的平面反射标靶中心点位置提取方法
CN107102641A (zh) * 2017-05-18 2017-08-29 湖北工业大学 一种基于激光引导双轮差速agv的原地偏航旋转方法
CN107390227A (zh) * 2017-07-13 2017-11-24 浙江科钛机器人股份有限公司 一种基于数据筛选的双反光板激光定位与导航方法
CN109104153A (zh) * 2018-09-07 2018-12-28 广东工业大学 一种反射式聚光系统
CN109633681A (zh) * 2018-12-05 2019-04-16 芜湖智久机器人有限公司 一种反光板识别方法及装置

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
XU HONGYU等: ""Reflection and Transmission Characteristics of Coupled Wave through Micropolar Elastic Solid Interlayer in Micropolar Fluid"", 《INTERNATIONAL JOURNAL OF AUTOMATION AND POWER ENGINEERING》 *
吴波: "基于激光雷达和反光板的移动机器人定位方法研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 *
左万权等: ""对2D激光雷达扫描到的反光板与环境中已知位置的反光板匹配问题进行研究"", 《万方》 *
杨志江 DENG: "激光导航AGV的反光板匹配技术研究", 《自动化应用》 *

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112305520A (zh) * 2020-10-27 2021-02-02 三一机器人科技有限公司 单激光雷达的反光柱检测位置的修正方法和装置
CN112305520B (zh) * 2020-10-27 2024-03-12 三一机器人科技有限公司 单激光雷达的反光柱检测位置的修正方法和装置
CN115220012A (zh) * 2022-09-20 2022-10-21 成都睿芯行科技有限公司 一种基于反光板定位方法
CN115616525A (zh) * 2022-12-06 2023-01-17 深圳煜炜光学科技有限公司 反射回波信号分辨方法、装置、设备及存储介质

Also Published As

Publication number Publication date
CN111722202B (zh) 2021-04-27

Similar Documents

Publication Publication Date Title
CN111722202B (zh) 一种基于回波强度的反光板位置拟合方法及系统
CN108549084B (zh) 一种基于稀疏二维激光雷达的目标检测与姿态估计方法
CN111443359B (zh) 定位方法、装置及设备
CN111369630A (zh) 一种多线激光雷达与相机标定的方法
CN111540001B (zh) 航空发动机涡轮叶片气膜孔轴线方向检测方法
CN113569958B (zh) 激光点云数据聚类方法、装置、设备及介质
CN113205563B (zh) 一种自动驾驶传感器联合标定靶和标定方法
CN115032648B (zh) 一种基于激光雷达密集点云的三维目标识别与定位方法
CN111679261B (zh) 一种基于反光板的激光雷达定位方法及系统
CN111427022A (zh) 一种基于极大似然估计的阵列雷达测角方法
CN109345571B (zh) 一种基于扩展高斯图像的点云配准方法
CN115081240A (zh) 一种提升仿真激光雷达数据真实性的点云数据处理方法
CN109708559B (zh) 一种基于隅角镜的光电自准直仪的测角方法
CN110954867A (zh) 一种声源定位方法、智能音箱及存储介质
CN112130166B (zh) 基于反光板网络的agv定位方法及装置
CN112734619B (zh) 一种面向检测特征扫描不确定度的自由曲面覆盖视点自动采样方法
CN117419641A (zh) 基于声学相机和深度相机的原木检尺方法及相关设备
CN110554405B (zh) 一种基于组合聚类的正态扫描配准方法和系统
CN110515060B (zh) 多线激光雷达反射率标定的方法
CN110907925B (zh) 一种高频地波雷达双站模型下的权重定位方法
CN116148800A (zh) 一种基于雷达的定日镜纠偏方法、装置、设备和介质
CN111504276B (zh) 一种基于视觉投影尺度因子集的联合目标函数多推进器姿态角获取方法
CN113553736B (zh) 一种结构有限元快速加载方法
Lin et al. Distance Measurement of Underwater Target Based on Stereo Vision
CN117974741B (zh) 一种360度点云深度带三角剖分构图方法、装置及系统

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