CN101451849B - 移动体视觉导航用多功能路标及综合导航方法 - Google Patents
移动体视觉导航用多功能路标及综合导航方法 Download PDFInfo
- Publication number
- CN101451849B CN101451849B CN200810154565XA CN200810154565A CN101451849B CN 101451849 B CN101451849 B CN 101451849B CN 200810154565X A CN200810154565X A CN 200810154565XA CN 200810154565 A CN200810154565 A CN 200810154565A CN 101451849 B CN101451849 B CN 101451849B
- Authority
- CN
- China
- Prior art keywords
- road sign
- slave part
- center
- moving body
- navigation
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Navigation (AREA)
- Traffic Control Systems (AREA)
Abstract
移动体视觉导航用多功能路标及综合导航方法。解决现有导航方法实时性不高、造价昂贵、路径不易改变等问题。本发明提供的多功能路标包括圆盘式路标主体和圆盘上用于指示下一路标所在方向和判断车体是否偏转的两个指针状结构的路标辅助部分。综合导航方法包括:依据行走路线将路标序列水平铺设在移动体上方;通过镜头获取场景图像,然后进行识别定位以及移动体纠偏,使移动体沿着设定的路线行走。基于该路标的导航算法不用对整幅图像进行处理,减少了计算量,提高了系统的实时性。基于该路标和导航算法的移动体不仅可以前进,还可以按原路线返回。
Description
【技术领域】:
本发明属于移动体的视觉导航技术领域。
【背景技术】:
视觉导航是移动体领域中的一个重要研究方向,具有很好的应用前景。
目前,视觉导航大致分为两类,一类需要事先建模,且算法复杂,实时性不高;另一类基于人为铺设的路标,这种方法不需要事先建模,且路径灵活,但因为需要对整个场景进行搜索而导致算法复杂,实时性差,观测物易丢失。
【发明内容】:
本发明目的是解决现有导航方法实时性不高、造价昂贵、路径不易改变等问题,提供一种简单、经济,路径可随意改变且实时性高的移动体视觉导航算法及适合该算法的路标。
本发明提供的移动体视觉导航用多功能路标设计为表盘式组合结构,路标主体是半径为R的圆盘,圆盘圆心为路标中心,圆盘上设有两个用于指示下一路标所在方向和判断车体是否偏转的指针状结构的路标辅助部分,即第一辅助部分和第二辅助部分;路标的主体与辅助部分采用两种不同的颜色。
路标辅助部分形状设计为梯型结构,其宽度为R,辅助部分内侧距离圆心为R/2,其中路标的第二辅助部分能够以圆盘的圆心为中心正负旋转90度。
一种移动体的综合导航方法,包括:
1)、将一组以上所述的多功能路标序列水平间隔铺设在移动体移动路径的上方;
2)、路标的识别定位,包括:
计算搜索范围;
对搜索范围内的图像进行前期处理;
计算路标的位置;
3)移动体导航,包括:
步骤1:判断是否需要寻找下一个路标,即判断当前路标中心纵坐标是否大于设定阈值T(需要寻找新路标的阈值),如果是则利用路标的第二辅助部分与路标中心预测下一路标所在方位,并将下一路标设为当前路标;
步骤2:利用路标中心与图像中心或路标第一辅助部分的关系,判断移动体是否跑偏,如果是则计算移动体的偏转角度。
所述的对搜索范围内的图像进行前期处理包括,对搜索范围内的图像进行颜色识别,利用路标主体部分和辅助部分的比例关系和位置关系排除其它颜色类似但不是路标的物体的干扰。
所述的计算路标的位置包括:
利用路标主体部分和辅助部分的比例关系和位置关系计算路标的中心位置;
在中心位置附近进行模板匹配,精确定位路标的中心位置。
本发明的优点和积极效果:
1、设计了一种新型路标,与传统路标相比,该路标为组合式结构,可以较好的排除颜色类似但非路标的物体的干扰,可以用于复杂环境。2、所发明的路标可以采用纸张、塑料等材质制成,非常经济,并且该路标结构简单,铺设方便,路径可随意改变。3、基于该路标的导航算法不仅可以对车体进行定位,还可以方便的计算车体的偏转角度,从而进行纠偏。4、基于该路标的导航算法不用对整幅图像进行处理,减少了计算量,提高了系统的实时性。5、基于该路标和导航算法的移动体不仅可以前进,还可以按原路线返回。
【附图说明】:
图1为路标外形示意图;
图2为导航算法流程图;
图3为预测下一路标位置示意图;
图4为路标中心不在图像中心时的移动体偏转角度示意图;
图5为路标中心在图像中心时的移动体偏转角度示意图;
图6为导航场景图;
图7为路标定位实例图;
图8为预测下一路标位置实例图;
图1中,1路标主体,2路标第一辅助部分,3路标第二辅助部分。
图4,图5中,虚线为移动体无偏转时的图片和路标在图片中的位置,实线为移动体偏转时的图片和路标在图片中的位置。
图7中,4搜索范围,5识别结果,6定位结果
图8中,7下一路标预测结果,8识别结果,9搜索范围。
【具体实施方式】:
实施例1:多功能路标设计
如图1所示,本发明提供的移动体视觉导航用多功能路标设计为表盘式组合结构,路标主体1是半径为R的圆盘,圆盘圆心为路标中心,圆盘上设有两个用于指示下一路标所在方向和判断车体是否偏转的指针状结构的路标辅助部分,即第一辅助部分2和第二辅助部分3;路标的主体与辅助部分采用两种不同的颜色,如主体采用黄色,辅助部分采用紫色。
路标辅助部分形状设计为梯型结构,其宽度为R,辅助部分内侧距离圆心为R/2,其中路标的第二辅助部分3能够以圆盘的圆心为中心正负旋转90度。
实施例2:综合导航方法
移动体的综合导航方法,包括:
1)、将一组实施例1所述的多功能路标序列水平间隔铺设在移动体移动路径的上方;
2)、路标的识别定位,包括:
计算搜索范围
对搜索范围内的图像进行前期处理,包括,对搜索范围内的图像进行颜色识别,利用路标主体部分和辅助部分的比例关系和位置关系排除其它颜色类似但不是路标的物体的干扰。
计算路标的位置:
利用路标主体部分和辅助部分的比例关系和位置关系计算路标的中心位置;
在中心位置附近进行模板匹配,精确定位路标的中心位置。
3)移动体导航,包括:
步骤1:(参见图3)判断是否需要寻找下一个路标,即判断当前路标中心纵坐标是否大于设定阈值T(需要寻找新路标的阈值),如果是则利用路标的第二辅助部分与路标中心预测下一路标所在方位,并将下一路标设为当前路标;
步骤2:(参见图4,图5)利用路标中心与图像中心或路标的第一辅助部分的关系,判断移动体是否跑偏,如果是则计算移动体的偏转角度。
本发明导航方法的具体过程如下:
在规定的路线上方间隔一定距离水平铺设路标;将镜头垂直于水平面向上固定在移动体顶部。导航时,实时获取图像,计算路标在图像中的位置,引导移动体依据路标所构成的路线行走,算法流程如图2所示。
关键算法如下:
1.已知图像中心坐标为(X,Y),需要重新寻找下一个路标的判断阈值为T,两路标在图像中距离为L,假设路标中心坐标为(X0,Y0),第一辅助部分的中心坐标为(X1,Y1),第二辅助部分的中心坐标为(X2,Y2)。
2.判断是否需要寻找新路标:如果Y0>T,则认为当前路标可以丢弃,应重新寻找新的路标。
3.预测下一路标(新路标)所在位置公式(参见图3):
X0′=X0+L×cosα
Y0′=Y0-L×sinα
其中: ——公式1
4.判断移动体是否偏转及偏转角度θ计算公式:
若X0=X且Y0<Y则认为移动体无偏转
否则认为偏转,计算偏转角:
如图4所示,当X0≠X时: ——公式2
如图5所示,当X0=X时: ——公式3
若θ>0,则移动体需要逆时针旋转θ;
若θ<0,则移动体需要顺时针旋转|θ|;
若θ=0,则移动体不偏转;
导航实例及计算结果
路标中心计算实例:如图7所示,图中4所示黑色区域为搜索区域,5所示高亮部分为处理后的路标,6所示白色方框的中心即为路标中心。
移动体偏转角度判断与计算实例:如图7所示
已知X=360,Y=288,T=275,X0=270,Y0=275,
因为Y0>T不成立,所以不用寻找新路标,
又因为X≠X0所以移动体有偏转(参见图4),将上述参数带入公式2可得:
小车需要逆时针旋转81.781°。
预测下一路标位置实例:如图8所示
已知T=275,X0=270,Y0=277,X2=288,Y2=258,L=170
因为Y0>T成立,所以需要寻找新路标(下一路标)。
(参见图3)将上述参数带入公式1可得:
X0′=270+170×cos46.6°=386.79≈386
Y0′=277-170×sin46.6°=153.75≈153
(386,153)即为新路标的位置,图中9所示黑色区域为搜索区域,8所示的高亮部分为处理后的路标,7所示白色方框的中心即为预测的下一路标中心。
Claims (4)
1.一种移动体视觉导航用多功能路标,其特征在于该路标为表盘式组合结构,路标主体是半径为R的圆盘,圆盘圆心为路标中心,圆盘上设有两个用于判断车体是否偏转和指示下一路标所在方向的指针状结构的路标辅助部分,即第一辅助部分和第二辅助部分,其中第一辅助部分用于判断车体是否偏转,第二辅助部分用于指示下一路标所在方向;所述的路标辅助部分形状设计为梯型结构,其宽度为R,两个路标辅助部分内侧距离圆心均为R/2,其中路标的第二辅助部分能够以圆盘的圆心为中心正负旋转90度;路标的主体与辅助部分采用两种不同的颜色。
2.一种移动体的综合导航方法,其特征在于该方法包括:
1)、将一组权利要求1中所述的多功能路标序列水平间隔铺设在移动体移动路径的上方;
2)、路标的识别定位,包括:
计算搜索范围;
对搜索范围内的图像进行前期处理;
计算路标的位置;
3)移动体导航,包括:
步骤1:判断是否需要寻找下一个路标,即判断当前路标中心纵坐标是否大于设定阈值T,如果是则利用路标的第二辅助部分与路标中心预测下一路标所在方位,并将下一路标设为当前路标;
步骤2:利用路标中心与图像中心或路标第一辅助部分的关系,判断移动体是否跑偏,是则计算移动体的偏转角度。
3.根据权利要求2所述的综合导航方法,其特征在于所述的对搜索范围内的图像进行前期处理包括,对搜索范围内的图像进行颜色识别,利用路标主体部分和辅助部分的比例关系和位置关系排除其它颜色类似但不是路标的物体的干扰。
4.根据权利要求2所述的综合导航方法,其特征在于所述的计算路标的位置包括:
利用路标主体部分和辅助部分的比例关系和位置关系计算路标的中心位置;
在中心位置附近进行模板匹配,精确定位路标的中心位置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN200810154565XA CN101451849B (zh) | 2008-12-26 | 2008-12-26 | 移动体视觉导航用多功能路标及综合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN200810154565XA CN101451849B (zh) | 2008-12-26 | 2008-12-26 | 移动体视觉导航用多功能路标及综合导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101451849A CN101451849A (zh) | 2009-06-10 |
CN101451849B true CN101451849B (zh) | 2011-06-15 |
Family
ID=40734218
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN200810154565XA Expired - Fee Related CN101451849B (zh) | 2008-12-26 | 2008-12-26 | 移动体视觉导航用多功能路标及综合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101451849B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101619984B (zh) * | 2009-07-28 | 2013-02-20 | 重庆邮电大学 | 一种基于颜色路标的移动机器人视觉导航方法 |
WO2011047508A1 (en) * | 2009-10-22 | 2011-04-28 | Tianjin University Of Technology | Embedded vision tracker and mobile guiding method for tracking sequential double color beacons array with extremely wide-angle lens |
CN104915705A (zh) * | 2015-07-08 | 2015-09-16 | 上海德马物流技术有限公司 | 仓储物流导航用视觉识别组合式色块标签 |
CN106323289A (zh) * | 2016-08-23 | 2017-01-11 | 北京小米移动软件有限公司 | 平衡车的控制方法及装置 |
CN108876857B (zh) * | 2018-07-02 | 2020-09-29 | 上海西井信息科技有限公司 | 无人驾驶车辆的定位方法、系统、设备及存储介质 |
CN109753075B (zh) * | 2019-01-29 | 2022-02-08 | 中国农业科学院农业资源与农业区划研究所 | 一种基于视觉的农林园区机器人导航方法 |
CN111309008B (zh) * | 2020-02-18 | 2023-04-28 | 南京师范大学 | 一种基于色彩识别的移动机器人导航方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1598487A (zh) * | 2004-07-23 | 2005-03-23 | 东北大学 | 人工路标视觉导航方法 |
CN101178314A (zh) * | 2007-11-22 | 2008-05-14 | 刘爱民 | 路标定位导航系统 |
-
2008
- 2008-12-26 CN CN200810154565XA patent/CN101451849B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1598487A (zh) * | 2004-07-23 | 2005-03-23 | 东北大学 | 人工路标视觉导航方法 |
CN101178314A (zh) * | 2007-11-22 | 2008-05-14 | 刘爱民 | 路标定位导航系统 |
Non-Patent Citations (2)
Title |
---|
刘大维,王江涛,严天一,陈秉聪.基于彩色视觉的自动引导车路标数别.《农业机械学报》.2006,第37卷(第4期),第87-90页. * |
郭阳,徐心和.变比不变量在机器视觉中的误差分析及应用.《东北大学学报(自然科学版)》.2007,第28卷(第8期),1077-1079. * |
Also Published As
Publication number | Publication date |
---|---|
CN101451849A (zh) | 2009-06-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101451849B (zh) | 移动体视觉导航用多功能路标及综合导航方法 | |
CN101660908B (zh) | 基于单个路标的视觉定位与导航方法 | |
CN109849922B (zh) | 一种用于智能车辆的基于视觉信息与gis信息融合的方法 | |
CN112400095B (zh) | 行驶环境信息的生成方法、驾驶控制方法、行驶环境信息生成装置 | |
CN103456185B (zh) | 智能车在城市道路行驶中的接力导航方法 | |
CN103148881B (zh) | 利用视频自动对指针式仪表进行读数的方法及装置 | |
CN109753081B (zh) | 一种基于机器视觉的巷道巡检无人机系统及导航方法 | |
CN107085938B (zh) | 基于车道线与gps跟随的智能驾驶局部轨迹容错规划方法 | |
CN101545783B (zh) | 道路形状推定装置、道路形状推定方法 | |
CN109946732A (zh) | 一种基于多传感器数据融合的无人车定位方法 | |
CN109325390B (zh) | 一种基于地图与多传感器检测相结合的定位方法及系统 | |
US20150363653A1 (en) | Road environment recognition system | |
CN104457719A (zh) | 矩形盾构施工的姿态测量装置及测量方法 | |
CN105759825A (zh) | 一种基于模糊pid的agv机器人定位控制算法 | |
CN105947239B (zh) | 一种基于矢量投影的航天器光学敏感器视场分析方法 | |
CN101672655A (zh) | 基于双轴光电测量系统的地面车位置、姿态及航向测量方法 | |
CN103234542A (zh) | 基于视觉的汽车列车弯道行驶轨迹测量方法 | |
CN104457691B (zh) | 一种建筑物主体高程信息获取方法 | |
CN111678503A (zh) | 一种无人机航测控制点布置和识别的方法及系统 | |
CN109323701A (zh) | 基于地图与多传感器检测相结合的定位方法及系统 | |
CN106292674A (zh) | 一种实时监控定位agv的方法 | |
CN106052660A (zh) | 与全站仪交互的自动锚点标识小车 | |
US20200264610A1 (en) | Autonomous Driving Control Device and Method | |
CN116380107B (zh) | 一种基于高精地图对车辆进行定位的系统 | |
CN111208820B (zh) | 人工智能大数据下粒子化无人车组、控制方法及介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
C17 | Cessation of patent right | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20110615 Termination date: 20131226 |