CN110031817A - 一种激光雷达反光板的快速匹配方法 - Google Patents
一种激光雷达反光板的快速匹配方法 Download PDFInfo
- Publication number
- CN110031817A CN110031817A CN201811618447.XA CN201811618447A CN110031817A CN 110031817 A CN110031817 A CN 110031817A CN 201811618447 A CN201811618447 A CN 201811618447A CN 110031817 A CN110031817 A CN 110031817A
- Authority
- CN
- China
- Prior art keywords
- reflector
- matching
- road sign
- sign point
- distance
- 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
Links
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
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Traffic Control Systems (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
本发明适用于自动控制技术领域,提供了一种激光雷达反光板的快速匹配方法,该方法包括如下步骤:S1、检测激光雷达在上一帧是否定位成功;S2、若检测结果为是,则基于动态匹配来匹配出当前帧中的已知反光板和未知反光板;若检测结果为否,则基于静态匹配来匹配出当前帧中的已知反光板和未知反光板。本发明提供的激光雷达反光板的快速匹配方法具有如下有益效果:分层进行匹配,提高了匹配的速度,提高匹配的可靠性。
Description
技术领域
本发明属于自动控制技术领域,提供了一种激光雷达反光板的快速匹配方法。
背景技术
随着社会的发展和技术的进步,移动机器人越来越深的介入到人类的日常生活中,例如家庭中的清洁机器人、工厂中的搬运机器人以及餐馆中的送餐机器人等。移动机器人想要实现上述功能必须要准确的知道自身所在的位置,即实时定位。而移动机器人实现实时定位的先决条件是建立地图,这是移动机器人导航和实施其它智能行为的关键。移动机器人导航常用的传感器有磁导航、摄像机和激光雷达等。其中磁导航的导航路径单一,不利于扩展和更改,使用的局限性较大。基于视觉的导航方法受光源条件影响大,稳定性和精度较差,无法让移动机器人进行稳定、精密的操作。基于激光雷达的导航方法可以分为基于反光板的导航方法和基于轮廓的导航方法,其中基于轮廓的定位方法计算量大、精度较差,无法适应移动机器人精密操作的要求;基于反光板的激光雷达定位方法精度高、稳定性好。基于反光板的激光雷达定位导航系统的关键就是反光板匹配,能否快速、准确将扫描到的反光板与地图中的路标点匹配,直接关系到地图构建和定位过程的速度和可靠性。
现有技术在能预测激光雷达位姿时采用动态匹配,否则采用静态匹配,动态匹配先计算反光板在当前位姿下的地图坐标,再计算反光板地图坐标与路标点的距离,当距离小于阈值时,将反光板与路标点匹配;静态匹配计算两两反光板的距离生成反光板距离列表,计算两两路标点的距离生成路标距离列表,对比两个距离列表,距离列表上的数据能一一对应的反光板与路标点判断为匹配成功。该技术方案存在如下的问题,动态匹配和静态匹配中,一个反光板可能同时匹配到多个路标点,或玻璃等非反光板的反射源也可能匹配到路标点,该技术方案无匹配筛选步骤,容易导致错误的匹配。
发明内容
本发明实施例提供一种激光雷达反光板的快速匹配方法,旨在提高反光板与路标点的匹配精准度。
为了实现上述目的,本发明提供了一种激光雷达反光板的快速匹配方法,该方法包括如下步骤:
S1、检测激光雷达在上一帧是否定位成功;
S2、若检测结果为是,则基于动态匹配来匹配出当前帧中的已知反光板和未知反光板;若检测结果为否,则基于静态匹配来匹配出当前帧中的已知反光板和未知反光板。
进一步的,所述静态匹配具体包括如下步骤:
S11、提取路标地图中的m个路标点,计算两两路标点之间的距离,得到全局距离列表D;
S12、提取当前帧中的n个反光板,计算两两反光板之间的距离,得到局部距离列表d;
S13、选择全局距离列表中的第i行Di与局部距离列表中的第j行dj,计算Di行中第k元素与dj行中第l个元素的绝对差值,若绝对差值小于matchW,则将第k个路标点加入到第l个反光板的候选匹配中,将Di行中的每一个元素与dj行中的每一个元素的绝对差值与matchW进行比较,得到Di与dj的匹配表matchListi,j;
S14、查找匹配表matchListi,j中的最佳组合,输出最佳匹配组合的匹配数目macth_count和匹配误差macth_err,若macth_count≥3且macth_err小于当前全局最优匹配的误差best_err,用当前匹配组合替换全局最优的匹配组合,令best_err=macth_err;
S15、检测当前j的取值是否等于n,若j≠n,则令j=j+1,并执行步骤S13,若j=n,则检测当前i的取值是否为m,若i≠m,则令i=i+1,j=1,执行步骤S13,若i=m,则输出全局最优匹配,若全局最优匹配的best_err<matchW,则反光板匹配成功,返回全局最优匹配组合,若best_err≥matchW,则输出匹配失败。
进一步的,所述动态匹配具体包括如下步骤:
S21、计算路标地图中所有路标点距激光雷达中心的距离,提取距离大于最小探测距离distmin,且小于最大探测距离distmax的路标点,共z个;
S22、基于激光雷达在上一帧中的位姿,计算n个反光板在路标地图中的坐标;
S23、计算反光板rk与路标点Rl的距离若将路标点Rl加入到反光板rk的匹配列表中;
S24、检测当前l的取值是否等于z,若l≠z,则令l=l+1,执行步骤S23,若l=z,则检测当前k的取值是否为n,若k≠n,则令k=k+1,l=1,执行步骤S23,若k=n,则输出匹配表matchList;
S25、查找匹配表matchList中的最优匹配组合,最优匹配组合的匹配数目大于2,且匹配组合的macth_err最小,最优匹配组合的匹配误差小于matchW,则认为反光板匹配成功,返回最优匹配组合,否则,匹配失败。
进一步的,匹配表中的最优匹配组合的获取方法包括如下步骤:
S31、按照设定的顺序从每个反光板的可能匹配路标点中选择一个,得到一个匹配组合
S32、删除匹配组合中错误匹配,获得匹配组合计算的匹配误差matchErr,若matchErr小于当前最佳匹配组合的匹配误差minErr,则将所述匹配组合设为最佳匹配,令minErr=matchErr,返回步骤S31,直至遍历匹配表中所有的匹配组合,输出最佳匹配、最佳匹配的匹配数目及匹配误差。
进一步的,所述匹配组合中的错误匹配删除方法包括如下步骤:
S321、从匹配组合中顺序提取n个反光板及其对应的路标点;
S322、计算第i个反光板ri与剩余反光板rj间距离以及路标点Ri与剩余路标点Rj间的距离路标点Ri为反光板ri的可能匹配路标点,路标点Rj为反光板ri的可能匹配路标点;
S323、计算与之差deta_dist,统计deta_dist小于matchW的个数macth_count_i,若macth_count_i≥3,则匹配组合的匹配数目macth_count加1,否则,将反光板ri的匹配路标点设为空;
S324、检测i是否等于n,若i≠n,则令i=i+1,并执行步骤S322,若i=n,则输出匹配组合及匹配组合的数目macth_count,若macth_count<3,则返回步骤S321,若macth_count≥3,执行步骤S325;
S325、将匹配组合中的反光板ri与反光板rj进行比较,检测反光板ri与反光板rj是否匹配到同一路标点;
S326、若反光板ri与反光板rj未匹配到同一路标点,则检测j是否等于n,若j≠n,令j=j+1,执行步骤S325,若j=n,则检测i是否等于n,若i≠n,令i=i+1,j=i+1,执行步骤S325,若i=n,则输出匹配组合若反光板ri与反光板rj匹配到同一路标点,则匹配组合的macth_count减去1,检测macth_count是否小于3,若macth_count<3,则返回步骤S321,若macth_count≥3,则执行步骤S327;
S327、提取反光板ri、rj及两反光板ri、rj的剩余反光板rm,剩余反光板中不包括匹配路标点为空的反光板;
S328、计算反光板ri与剩余反光板rm之间的距离及路标点Ri与剩余路标点Rm间的距离计算距离差将距离差进行累积,获得累积距离差sumi;计算反光板rj与剩余反光板rm之间的距离计算路标点Rj与剩余路标点Rm间的距离计算距离差将距离差进行累积,获得累积距离差sumj,其中,路标点Ri为反光板ri在匹配组合中的匹配路标点,路标点Rm为反光板rm在该匹配组合中的匹配路标点;
S329、比较sumi与sumj,若sumi<sumj,则保留反光板ri匹配的路标点,将反光板rj的匹配路标点设为空,若sumi>sumj,保留反光板rj匹配的路标点,将反光板ri的匹配路标点设为空;
S330、在匹配组合中提取匹配路标点不为空的s个反光板;
S331、计算反光板ri与反光板rj之间的距离及路标点Ri与路标点Rj之间的距离路标点Ri与路标点Rj分别为反光板ri与反光板rj在匹配组合中的匹配路标点;
S332、计算与的差值,若与的差值大于matchW,则执行步骤S333;若与的差值小于或等于matchW,检测j是否等于s,若j≠s,令j=j+1,执行步骤S331,若j=s,则检测i是否等于s,若i≠s,则令i=i+1,j=i+1,执行步骤S331,若i=s,则输出
S333、将匹配组合的macth_count减1,若macth_count<3,则返回步骤S321,若macth_count≥3,则执行步骤S334;
S334、提取反光板ri、rj及两反光板ri、rj的剩余反光板rm,且剩余反光板中不包括匹配路标点为空的反光板;
S335、计算反光板ri与剩余反光板rm间的距离及路标点Ri与剩余路标点Rm间的距离计算距离差将距离差进行累积,获得累积距离差sumi,计算反光板rj与剩余反光板rm间的距离及路标点Rj与剩余路标点Rm间的距离计算距离差将距离差进行累积,获得累积距离差sumj,其中,路标点Ri为反光板ri在匹配组合中的匹配路标点,路标点Rm为反光板rm在匹配组合中的匹配路标点;
S336、将sumi与sumj进行比较,若sumi<sumj,则保留反光板ri匹配的路标点,将反光板rj的匹配路标点设为空,sumi≥sumj,保留反光板rj匹配的路标点,将反光板ri的匹配路标点设为空。
本发明提供的激光雷达反光板的快速匹配方法具有如下有益效果:分层进行匹配,提高了匹配的速度,提高匹配的可靠性。
附图说明
图1为本发明实施例提供的激光雷达反光板的快速匹配方法流程图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
本发明利用激光雷达进行定位时,能够将扫描到的反光板与路标地图中的路标点进行匹配,筛选出反光板中的非路标点,激光雷达水平放置,反光板垂直于地面张贴,将激光雷达的扫描线与反光板的中点大致对齐。
反光板匹配可分为静态匹配和动态匹配,在利用激光雷达和反光板进行定位时,通常会使用上一帧的激光雷达位姿来预测激光雷达当前的位姿,比如初始化或激光雷达在上一帧定位失败时,使用静态匹配来匹配反光板,否则使用动态匹配来匹配反光板。设置反光板匹配允许的误差为matchW,图1为本发明实施例提供的激光雷达反光板的快速匹配方法流程图,该激光雷达反光板的匹配方法如下:
S1、检测激光雷达在上一帧是否定位成功;
S2、若检测结果为是,则基于动态匹配来匹配出当前帧中的已知反光板和未知反光板;若检测结果为否,则基于静态匹配来匹配出当前帧中的已知反光板和未知反光板。
首次构建路标地图时,或者是激光雷达在上一帧中定位失败时,则基于静态匹配来获取当前帧中的已知反光板,反光板即为路标地图中的路标点,已知反光板是指已经纳入路标地图中的反光板,未知反光板是指未纳入路标地图中的反光板,构建路标地图的过程即是不断的将未知反光板纳入路标地图的过程,直至所有的未知反光板都纳入路标地图,则路标地图构建完毕。
在本发明实施例中,扫描到的反光板与地图里的路标点匹配上,已知路标地图中所有路标点坐标、当前帧的反光板在激光雷达坐标系中的坐标,定义全局最优匹配的误差best_err等于无穷大,本发明中的静态匹配具体包括如下步骤:
S11、根据路标地图中m个路标点R1(X1,Y1),...,Rm(Xm,Ym),计算两两路标点之间的距离,得到全局距离列表D1,2,...,D1,m;...;Dm,1,...,Dm,m-1;
其中,Dm,m-1表示路标点Rm与路标点Rm-1之间的距离,(Xm,Ym)为第m个路标点Rm在路标地图中的坐标;
S12、根据当前帧中的n个反光板r1(x1,y1),...,rn(xn,yn),计算两两反光板之间的距离,得到局部距离列表d1,2,....,d1,n;....;dn,1,...,dn,n-1;
dn,n-1表示反光板rn与反光板rn-1之间的距离,(xn,yn)为第n个反光板rn在激光雷达坐标系中的坐标,根据激光雷达探测距离与反光板反射强度之间的关系筛选出反光板上的扫描点,利用单个反光板上的反射点集拟合得到反光板中心,检测反光板中心距激光雷达中心的距离di及角度θi,用ri(di,θi)来表示反光板ri的中心距激光雷达中心的距离di及夹角θi,基于ri(di,θi)计算反光板中心在激光雷达坐标系中的坐标。
S13、选择全局距离列表中的第i行Di与局部距离列表中的第j行dj,假设路标地图中第i个路标点与当前帧中的第j个反光板匹配成功,将Di行中的每一个元素与dj行中的每一个元素进行对比,若Di行中的第k个元素,与dj行中的第l个元素满足abs(Di,k-dj,l)<matchW,则将第k个路标点加入到第l个反光板的候选匹配中,对比结束得到Di与dj的匹配表matchListi,j={r1:Ri,...;...;rn:Rj,...};
S14、对匹配表matchListi,j进行最佳匹配查找,得到当前最佳的匹配组合、匹配数目macth_count和匹配误差macth_err。若macth_count≥3且macth_err小于全局最优匹配的误差best_err,用当前匹配组合替换全局最优的匹配组合,令best_err=macth_err;
S15、检测当前j的取值是否等于n,若j≠n,则令j=j+1,并执行步骤S13,若j=n,则检测当前i的取值是否为m,若i≠m,则令i=i+1,j=1,执行步骤S13,若i=m,则输出全局最优匹配,若全局最优匹配的best_err<matchW,则反光板匹配成功,返回全局最优匹配组合,若best_err≥matchW,则输出匹配失败。
在本发明实施例中,反光板的动态匹配具体包括如下步骤:
在激光雷达在上一帧中的位姿获取成功,在上一帧中的位姿为pose(x,y,θ),基于动态匹配来寻找反光板对应的路标点,动态匹配的步骤如下:
S21、计算路标地图中所有路标点R1(X1,Y1),....,Rm(Xm,Ym)距激光雷达中心的距离,提取距离大于最小探测距离distmin,且小于最大探测距离distmax的路标点R1(X1,Y1),....,Rz(Xz,Yz)
S22、基于激光雷达在上一帧中的位姿pose(x,y,θ),计算n个反光板r1(x1,y1),...,rn(xn,yn)在路标地图中的坐标P(x,y),
S23、计算反光板rk与路标点Rl的距离若将路标点Rl加入到反光板rk的匹配列表中;
S24、检测当前l的取值是否等于z,若l≠z,则令l=l+1,执行步骤S23,若l=z,则检测当前k的取值是否为n,若k≠n,则令k=k+1,l=1,执行步骤S23,若k=n,则输出匹配表matchList r1:Ri,....;....;rn:Rj,...;
S25、查找匹配表matchList中的最优匹配组合,若最优匹配组合的匹配数目大于2,且macth_err最小,若最优匹配组合的匹配误差小于matchW,则认为反光板匹配成功,返回最优匹配组合,否则,匹配失败。
在本发明实施例中,静态匹配及动态匹配中匹配表中的最佳匹配查找方法具体如下:
S31、按照设定的顺序从每个反光板的可能匹配路标点中选择一个,得到一个匹配组合
已知当前扫描到n个反光板,每个反光板所有的可能匹配为r1:Ri,....;....;rn:Rj,...,设置当前最佳匹配的误差为minErr。
S32、删除匹配组合中错误匹配,获得匹配组合计算的匹配误差matchErr,若matchErr小于当前最佳匹配组合的匹配误差minErr,则将所述匹配组合设为当前最佳匹配,令minErr=matchErr,返回步骤S31,直至遍历匹配表中所有的匹配组合,输出最佳匹配、最佳匹配的匹配数目及匹配误差。
在本发明实施例中,错误匹配的删除方法具体包括如下步骤:
S321、从匹配组合中顺序提取n个反光板及其对应的路标点;
S322、计算第i个反光板ri与剩余反光板rj(j≠i)间距离以及路标点Ri与剩余路标点Rj(j≠i)间的距离路标点Ri为反光板ri的可能匹配路标点,路标点Rj为反光板ri的可能匹配路标点;
S323、计算与之差deta_dist,统计deta_dist小于matchW的个数macth_count_i,若macth_count_i≥3,则匹配组合的匹配数目macth_count加1,否则,将反光板ri的匹配路标点设为空;
S324、检测i是否等于n,若i≠n,则令i=i+1,并执行步骤S322,若i=n,则输出匹配组合即将更新为及匹配组合的数目macth_count,若macth_count<3,则返回步骤S321,若macth_count≥3,执行步骤S325;
S325、将匹配组合中的反光板ri与反光板rj进行比较,检测反光板ri与反光板rj是否匹配到同一路标点;
S326、若反光板ri与反光板rj未匹配到同一路标点,则检测j是否等于n,若j≠n,令j=j+1,执行步骤S325,若j=n,则检测i是否等于n,若i≠n,令i=i+1,j=i+1执行步骤S325,若i=n,则输出匹配组合若反光板ri与反光板rj匹配到同一路标点,则匹配组合的macth_count减去1,检测macth_count是否小于3,若macth_count<3,则返回步骤S321,若macth_count≥3,则执行步骤S327;
S327、提取反光板ri、rj及两反光板ri、rj的剩余反光板rm(m≠i,j),剩余反光板中不包括匹配路标点为空的反光板;
S328、计算反光板ri与剩余反光板rm之间的距离及路标点Ri与剩余路标点Rm间的距离计算距离差将距离差进行累积计算反光板rj与剩余反光板rm之间的距离计算路标点Rj与剩余路标点Rm间的距离计算距离差将距离差进行累积其中,路标点Ri为反光板ri在匹配组合中的匹配路标点,路标点Rm为反光板rm在该匹配组合中的匹配路标点;
S329、比较sumi与sumj,若sumi<sumj,则保留反光板ri匹配的路标点,将反光板rj的匹配路标点设为空,若sumi>sumj,保留反光板rj匹配的路标点,将反光板ri的匹配路标点设为空;
S330、在匹配组合中提取匹配路标点不为空的反光板r1,...,rs;
S331、计算反光板ri与反光板rj之间的距离及路标点Ri与路标点Rj之间的距离路标点Ri与路标点Rj分别为反光板ri与反光板rj在匹配组合中的匹配路标点;
S332、计算与的差值,若与的差值大于matchW,则执行步骤S333;若与的差值小于或等于matchW,检测j是否等于s,若j≠s,令j=j+1,执行步骤S331,若j=s,则检测i是否等于s,若i≠s,则令i=i+1,j=i+1,执行步骤S331,若i=s,则输出
S333、反光板ri与反光板rj之间至少有一个匹配错误,令匹配组合的macth_count减1,若macth_count<3,则返回步骤S321,若macth_count≥3,则执行步骤S334;
S334、提取反光板ri、rj及两反光板ri、rj的剩余反光板rm(m≠i,j),且剩余反光板中不包括匹配路标点为空的反光板;
S335、计算反光板ri与剩余反光板rm间的距离及路标点Ri与剩余路标点Rm间的距离计算距离差将距离差进行累积计算反光板rj与剩余反光板rm间的距离及路标点Rj与剩余路标点Rm间的距离计算距离差将距离差进行累积其中,路标点Ri为反光板ri在匹配组合中的匹配路标点,路标点Rm为反光板rm在匹配组合中的匹配路标点;
S336、将sumi与sumj进行比较,若sumi<sumj,则保留反光板ri匹配的路标点,将反光板rj的匹配路标点设为空,sumi≥sumj,保留反光板rj匹配的路标点,将反光板ri的匹配路标点设为空。
本发明提供的激光雷达反光板的快速匹配方法具有如下有益效果:分层进行匹配,提高了匹配的速度,提高匹配的可靠性。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (5)
1.一种激光雷达反光板的快速匹配方法,其特征在于,所述方法包括如下步骤:
S1、检测激光雷达在上一帧是否定位成功;
S2、若检测结果为是,则基于动态匹配来匹配出当前帧中的已知反光板和未知反光板;若检测结果为否,则基于静态匹配来匹配出当前帧中的已知反光板和未知反光板。
2.如权利要求1所述激光雷达反光板的快速匹配方法,其特征在于,所述静态匹配具体包括如下步骤:
S11、提取路标地图中的m个路标点,计算两两路标点之间的距离,得到全局距离列表D;
S12、提取当前帧中的n个反光板,计算两两反光板之间的距离,得到局部距离列表d;
S13、选择全局距离列表中的第i行Di与局部距离列表中的第j行dj,计算Di行中第k元素与dj行中第l个元素的绝对差值,若绝对差值小于matchW,则将第k个路标点加入到第l个反光板的候选匹配中,将Di行中的每一个元素与dj行中的每一个元素的绝对差值与matchW进行比较,得到Di与dj的匹配表matchListi,j;
S14、查找匹配表matchListi,j中的最佳组合,输出最佳匹配组合的匹配数目macth_count和匹配误差macth_err,若macth_count≥3且macth_err小于当前全局最优匹配的误差best_err,用当前匹配组合替换全局最优的匹配组合,令best_err=macth_err;
S15、检测当前j的取值是否等于n,若j≠n,则令j=j+1,并执行步骤S13,若j=n,则检测当前i的取值是否为m,若i≠m,则令i=i+1,j=1,执行步骤S13,若i=m,则输出全局最优匹配,若全局最优匹配的best_err<matchW,则反光板匹配成功,返回全局最优匹配组合,若best_err≥matchW,则输出匹配失败。
3.如权利要求1所述激光雷达反光板的快速匹配方法,其特征在于,所述动态匹配具体包括如下步骤:
S21、计算路标地图中所有路标点距激光雷达中心的距离,提取距离大于最小探测距离distmin,且小于最大探测距离distmax的路标点,共z个;
S22、基于激光雷达在上一帧中的位姿,计算n个反光板在路标地图中的坐标;
S23、计算反光板rk与路标点Rl的距离若将路标点Rl加入到反光板rk的匹配列表中;
S24、检测当前l的取值是否等于z,若l≠z,则令l=l+1,执行步骤S23,若l=z,则检测当前k的取值是否为n,若k≠n,则令k=k+1,l=1,执行步骤S23,若k=n,则输出匹配表matchList;
S25、查找匹配表matchList中的最优匹配组合,最优匹配组合的匹配数目大于2,且匹配组合的macth_err最小,最优匹配组合的匹配误差小于matchW,则认为反光板匹配成功,返回最优匹配组合,否则,匹配失败。
4.如权利要求2或3所述激光雷达反光板的快速匹配方法,其特征在于,匹配表中的最优匹配组合的获取方法包括如下步骤:
S31、按照设定的顺序从每个反光板的可能匹配路标点中选择一个,得到一个匹配组合
S32、删除匹配组合中错误匹配,获得匹配组合计算的匹配误差matchErr,若matchErr小于当前最佳匹配组合的匹配误差minErr,则将所述匹配组合设为最佳匹配,令minErr=matchErr,返回步骤S31,直至遍历匹配表中所有的匹配组合,输出最佳匹配、最佳匹配的匹配数目及匹配误差。
5.如权利要求4所述激光雷达反光板的快速匹配方法,其特征在于,所述匹配组合中的错误匹配删除方法包括如下步骤:
S321、从匹配组合中顺序提取n个反光板及其对应的路标点;
S322、计算第i个反光板ri与剩余反光板rj间距离以及路标点Ri与剩余路标点Rj间的距离路标点Ri为反光板ri的可能匹配路标点,路标点Rj为反光板ri的可能匹配路标点;
S323、计算与之差deta_dist,统计deta_dist小于matchW的个数macth_count_i,若macth_count_i≥3,则匹配组合的匹配数目macth_count加1,否则,将反光板ri的匹配路标点设为空;
S324、检测i是否等于n,若i≠n,则令i=i+1,并执行步骤S322,若i=n,则输出匹配组合及匹配组合的数目macth_count,若macth_count<3,则返回步骤S321,若macth_count≥3,执行步骤S325;
S325、将匹配组合中的反光板ri与反光板rj进行比较,检测反光板ri与反光板rj是否匹配到同一路标点;
S326、若反光板ri与反光板rj未匹配到同一路标点,则检测j是否等于n,若j≠n,令j=j+1,执行步骤S325,若j=n,则检测i是否等于n,若i≠n,令i=i+1,j=i+1,执行步骤S325,若i=n,则输出匹配组合若反光板ri与反光板rj匹配到同一路标点,则匹配组合的macth_count减去1,检测macth_count是否小于3,若macth_count<3,则返回步骤S321,若macth_count≥3,则执行步骤S327;
S327、提取反光板ri、rj、及两反光板ri、rj的剩余反光板rm,剩余反光板中不包括匹配路标点为空的反光板;
S328、计算反光板ri与剩余反光板rm之间的距离及路标点Ri与剩余路标点Rm间的距离计算距离差将距离差进行累积,获得累积距离差sumi;计算反光板rj与剩余反光板rm之间的距离计算路标点Rj与剩余路标点Rm间的距离计算距离差将距离差进行累积,获得累积距离差sumj,其中,路标点Ri为反光板ri在匹配组合中的匹配路标点,路标点Rm为反光板rm在该匹配组合中的匹配路标点;
S329、比较sumi与sumj,若sumi<sumj,则保留反光板ri匹配的路标点,将反光板rj的匹配路标点设为空,若sumi>sumj,保留反光板rj匹配的路标点,将反光板ri的匹配路标点设为空;
S330、在匹配组合中提取匹配路标点不为空的s个反光板;
S331、计算反光板ri与反光板rj之间的距离及路标点Ri与路标点Rj之间的距离路标点Ri与路标点Rj分别为反光板ri与反光板rj在匹配组合中的匹配路标点;
S332、计算与的差值,若与的差值大于matchW,则执行步骤S333;若与的差值小于或等于matchW,检测j是否等于s,若j≠s,令j=j+1,执行步骤S331,若j=s,则检测i是否等于s,若i≠s,则令i=i+1,j=i+1,执行步骤S331,若i=s,则输出
S333、将匹配组合的macth_count减1,若macth_count<3,则返回步骤S321,若macth_count≥3,则执行步骤S334;
S334、提取反光板ri、rj、及两反光板ri、rj的剩余反光板rm,且剩余反光板中不包括匹配路标点为空的反光板;
S335、计算反光板ri与剩余反光板rm间的距离及路标点Ri与剩余路标点Rm间的距离计算距离差将距离差进行累积,获得累积距离差sumi,计算反光板rj与剩余反光板rm间的距离及路标点Rj与剩余路标点Rm间的距离计算距离差将距离差进行累积,获得累积距离差sumj,其中,路标点Ri为反光板ri在匹配组合中的匹配路标点,路标点Rm为反光板rm在匹配组合中的匹配路标点;
S336、将sumi与sumj进行比较,若sumi<sumj,则保留反光板ri匹配的路标点,将反光板rj的匹配路标点设为空,sumi≥sumj,保留反光板rj匹配的路标点,将反光板ri的匹配路标点设为空。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811618447.XA CN110031817B (zh) | 2018-12-28 | 2018-12-28 | 一种激光雷达反光板的快速匹配方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811618447.XA CN110031817B (zh) | 2018-12-28 | 2018-12-28 | 一种激光雷达反光板的快速匹配方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110031817A true CN110031817A (zh) | 2019-07-19 |
CN110031817B CN110031817B (zh) | 2022-05-27 |
Family
ID=67235443
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811618447.XA Active CN110031817B (zh) | 2018-12-28 | 2018-12-28 | 一种激光雷达反光板的快速匹配方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110031817B (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111060092A (zh) * | 2019-12-31 | 2020-04-24 | 芜湖哈特机器人产业技术研究院有限公司 | 一种反光柱的快速匹配方法 |
CN111273304A (zh) * | 2019-12-31 | 2020-06-12 | 芜湖哈特机器人产业技术研究院有限公司 | 一种融合反光柱的自然定位方法及系统 |
CN111352118A (zh) * | 2020-03-25 | 2020-06-30 | 三一机器人科技有限公司 | 反光柱的匹配方法、装置、激光雷达定位方法和设备终端 |
CN111580089A (zh) * | 2020-05-11 | 2020-08-25 | 北京小狗智能机器人技术有限公司 | 一种定位方法和相关装置 |
CN111830491A (zh) * | 2020-08-04 | 2020-10-27 | 三一机器人科技有限公司 | 一种导航系统中反光体的监测方法、装置及电子设备 |
CN113666305A (zh) * | 2021-08-31 | 2021-11-19 | 杭州派珞特智能技术有限公司 | 基于运动补偿与反射板优化排序的智能叉车激光定位方法 |
CN114237047A (zh) * | 2021-12-10 | 2022-03-25 | 广东工业大学 | 一种基于约束分类的时间最优速度规划方法及系统 |
WO2023005020A1 (zh) * | 2021-07-30 | 2023-02-02 | 深圳市优必选科技股份有限公司 | 反光板定位方法、机器人及计算机可读存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009270957A (ja) * | 2008-05-08 | 2009-11-19 | Ihi Corp | レーザレーダ及びレーザレーダの較正方法 |
KR20160129487A (ko) * | 2015-04-30 | 2016-11-09 | 영남대학교 산학협력단 | 2차원 레이저 스캐너를 이용한 차선 검출 장치 및 방법 |
CN106651990A (zh) * | 2016-12-23 | 2017-05-10 | 芜湖哈特机器人产业技术研究院有限公司 | 一种室内地图构建方法及基于室内地图的室内定位方法 |
CN107144855A (zh) * | 2017-07-13 | 2017-09-08 | 浙江科钛机器人股份有限公司 | 一种基于双反光板的激光定位与导航方法 |
CN107289946A (zh) * | 2017-07-13 | 2017-10-24 | 浙江科钛机器人股份有限公司 | 一种基于双反光板的高精度激光定位与导航方法 |
CN208283559U (zh) * | 2018-06-04 | 2018-12-25 | 驭势科技(浙江)有限公司 | 激光雷达探测装置以及智能驾驶汽车 |
-
2018
- 2018-12-28 CN CN201811618447.XA patent/CN110031817B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009270957A (ja) * | 2008-05-08 | 2009-11-19 | Ihi Corp | レーザレーダ及びレーザレーダの較正方法 |
KR20160129487A (ko) * | 2015-04-30 | 2016-11-09 | 영남대학교 산학협력단 | 2차원 레이저 스캐너를 이용한 차선 검출 장치 및 방법 |
CN106651990A (zh) * | 2016-12-23 | 2017-05-10 | 芜湖哈特机器人产业技术研究院有限公司 | 一种室内地图构建方法及基于室内地图的室内定位方法 |
CN107144855A (zh) * | 2017-07-13 | 2017-09-08 | 浙江科钛机器人股份有限公司 | 一种基于双反光板的激光定位与导航方法 |
CN107289946A (zh) * | 2017-07-13 | 2017-10-24 | 浙江科钛机器人股份有限公司 | 一种基于双反光板的高精度激光定位与导航方法 |
CN208283559U (zh) * | 2018-06-04 | 2018-12-25 | 驭势科技(浙江)有限公司 | 激光雷达探测装置以及智能驾驶汽车 |
Non-Patent Citations (1)
Title |
---|
倪振: "激光导引四轮差动全方位移动AGV关键技术研究", 《中国优秀博硕士学位论文全文数据库(硕士)信息科技辑》 * |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111060092A (zh) * | 2019-12-31 | 2020-04-24 | 芜湖哈特机器人产业技术研究院有限公司 | 一种反光柱的快速匹配方法 |
CN111273304A (zh) * | 2019-12-31 | 2020-06-12 | 芜湖哈特机器人产业技术研究院有限公司 | 一种融合反光柱的自然定位方法及系统 |
CN111060092B (zh) * | 2019-12-31 | 2021-07-30 | 芜湖哈特机器人产业技术研究院有限公司 | 一种反光柱的快速匹配方法 |
CN111273304B (zh) * | 2019-12-31 | 2022-05-24 | 芜湖哈特机器人产业技术研究院有限公司 | 一种融合反光柱的自然定位方法及系统 |
CN111352118A (zh) * | 2020-03-25 | 2020-06-30 | 三一机器人科技有限公司 | 反光柱的匹配方法、装置、激光雷达定位方法和设备终端 |
CN111580089A (zh) * | 2020-05-11 | 2020-08-25 | 北京小狗智能机器人技术有限公司 | 一种定位方法和相关装置 |
CN111830491A (zh) * | 2020-08-04 | 2020-10-27 | 三一机器人科技有限公司 | 一种导航系统中反光体的监测方法、装置及电子设备 |
WO2023005020A1 (zh) * | 2021-07-30 | 2023-02-02 | 深圳市优必选科技股份有限公司 | 反光板定位方法、机器人及计算机可读存储介质 |
CN113666305A (zh) * | 2021-08-31 | 2021-11-19 | 杭州派珞特智能技术有限公司 | 基于运动补偿与反射板优化排序的智能叉车激光定位方法 |
CN113666305B (zh) * | 2021-08-31 | 2023-02-21 | 杭州派珞特智能技术有限公司 | 基于运动补偿与反射板优化排序的智能叉车激光定位方法 |
CN114237047A (zh) * | 2021-12-10 | 2022-03-25 | 广东工业大学 | 一种基于约束分类的时间最优速度规划方法及系统 |
US11709467B2 (en) | 2021-12-10 | 2023-07-25 | Guangdong University Of Technology | Time optimal speed planning method and system based on constraint classification |
Also Published As
Publication number | Publication date |
---|---|
CN110031817B (zh) | 2022-05-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110031817A (zh) | 一种激光雷达反光板的快速匹配方法 | |
CN109613550A (zh) | 一种基于反光板的激光雷达地图构建及定位方法 | |
CN109613549A (zh) | 一种基于卡尔曼过滤的激光雷达定位方法 | |
CN109631919A (zh) | 一种融合反光板和占据栅格的混合导航地图构建方法 | |
CN109613547A (zh) | 一种基于反光板的占据栅格地图构建方法 | |
CN109613548A (zh) | 一种基于图优化的激光雷达路标地图构建方法 | |
CN112268559B (zh) | 复杂环境下融合slam技术的移动测量方法 | |
Olson et al. | Robust range-only beacon localization | |
WO2019055691A1 (en) | MULTI-RESOLUTION SIMULTANEOUS LOCATION AND MAPPING BASED ON LIDAR 3D MEASUREMENTS | |
CN115407357B (zh) | 基于大场景的低线束激光雷达-imu-rtk定位建图算法 | |
Bosse | ATLAS: a framework for large scale automated mapping and localization | |
CN109186616A (zh) | 基于高精度地图和场景检索的车道线辅助定位方法 | |
CN103377476A (zh) | 使用三维地理弧的多模型数据的图像配准 | |
CN110187375A (zh) | 一种基于slam定位结果提高定位精度的方法及装置 | |
CN107063229A (zh) | 基于人工路标的移动机器人定位系统及方法 | |
US20230236280A1 (en) | Method and system for positioning indoor autonomous mobile robot | |
CN109143161B (zh) | 基于混合指纹质量评价模型的高精度室内定位方法 | |
CN110187372A (zh) | 一种低速无人车园区内组合导航方法及系统 | |
Huang et al. | Vision-based semantic mapping and localization for autonomous indoor parking | |
CN112580479A (zh) | 一种基于空洞卷积神经网络的地磁式室内定位系统 | |
CN115728803A (zh) | 一种城市驾驶车辆连续定位系统及方法 | |
CN109613571B (zh) | 一种基于双极化天线的城市峡谷内卫星定位方法 | |
JP2022547373A (ja) | セルラーベースのナビゲーション方法 | |
CN116358547B (zh) | 一种基于光流估计获取agv位置的方法 | |
CN116127405A (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 |