CN107121981A - 一种基于视觉的agv巡线导航和定位方法 - Google Patents
一种基于视觉的agv巡线导航和定位方法 Download PDFInfo
- Publication number
- CN107121981A CN107121981A CN201710261202.5A CN201710261202A CN107121981A CN 107121981 A CN107121981 A CN 107121981A CN 201710261202 A CN201710261202 A CN 201710261202A CN 107121981 A CN107121981 A CN 107121981A
- Authority
- CN
- China
- Prior art keywords
- navigation
- agv
- graticule
- line
- image
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 35
- 230000009184 walking Effects 0.000 title claims abstract description 19
- 230000004807 localization Effects 0.000 title claims abstract description 8
- 238000000605 extraction Methods 0.000 claims description 11
- 238000001914 filtration Methods 0.000 claims description 8
- 230000000007 visual effect Effects 0.000 abstract description 4
- 235000004443 Ricinus communis Nutrition 0.000 abstract description 3
- 230000001186 cumulative effect Effects 0.000 abstract description 3
- 238000012423 maintenance Methods 0.000 abstract description 3
- 230000009466 transformation Effects 0.000 abstract description 2
- 230000006641 stabilisation Effects 0.000 abstract 1
- 238000011105 stabilization Methods 0.000 abstract 1
- 230000004927 fusion Effects 0.000 description 10
- 238000005070 sampling Methods 0.000 description 5
- 239000013598 vector Substances 0.000 description 5
- 239000011159 matrix material Substances 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 3
- 230000003287 optical effect Effects 0.000 description 3
- 239000004020 conductor Substances 0.000 description 2
- 239000000284 extract Substances 0.000 description 2
- 230000033001 locomotion Effects 0.000 description 2
- 241000287196 Asthenes Species 0.000 description 1
- 241001212149 Cathetus Species 0.000 description 1
- 241001465805 Nymphalidae Species 0.000 description 1
- 239000002390 adhesive tape Substances 0.000 description 1
- 230000001174 ascending effect Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000002146 bilateral effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000036461 convulsion Effects 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000000151 deposition Methods 0.000 description 1
- 230000005674 electromagnetic induction Effects 0.000 description 1
- 239000003550 marker Substances 0.000 description 1
- 230000000630 rising effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0217—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with energy consumption, time reduction or distance reduction criteria
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C11/00—Photogrammetry or videogrammetry, e.g. stereogrammetry; Photographic surveying
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C11/00—Photogrammetry or videogrammetry, e.g. stereogrammetry; Photographic surveying
- G01C11/04—Interpretation of pictures
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Multimedia (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Image Analysis (AREA)
Abstract
本发明公开了一种基于视觉的AGV巡线导航和定位方法,该方法包括:获得当前航向前方的图像;根据导航标线的第一预设特征,从图像中识别出符合第一预设特征的导航标线对象;获取AGV与导航标线的相对位置关系,并利用相对位置关系修正AGV的位置与航向。本发明采用图像采集设备替代磁导引传感器,采用彩色胶带铺设辅助路径,极大低降低了导航路径改造和维护成本。针对图像采集设备感知视野小的缺点,通过融合视觉特征和里程计信息,准确的跟踪AGV的实时位姿。同时,针对可移动设备侧滑、脚轮打滑等原因导致的里程计累计误差,通过设置全局坐标已知的位置修正标记修正AGV的里程计信息,从而实现AGV高精度、稳定的定位和导航。
Description
技术领域
本发明涉及一种AGV导航和定位方法,尤其是涉及一种基于视觉的AGV巡线导航和定位方法。
背景技术
传统的巡线导航方法中,基于磁导引、电磁感应等的导引方式,这些方法涉及到磁条或导引线的铺设,需要对现有环境进行改造,且维护成本大。另外,基于激光的无轨导航方法中,激光传感器通常十分昂贵,无法实现普遍应用推广,并且在周围环境发生大范围变化时易引起定位丢失进而使导航失败。
传统的定位方法采用里程计定位,随着可移动设备行程的增加,可移动设备侧滑、脚轮打滑等原因都会导致里程计偏差逐渐累积,造成可移动设备位姿反馈不准确。由于技术和成本限制,对机器人轨迹巡线导航和定位,目前还没有低成本的、稳定的解决方案。
随着视觉识别技术在移动机器人领域得到了快速发展和广泛应用,低成本的USB相机更能满足可移动设备导航的实时性和经济性等要求,已经越来越多的用于可移动设备的自主导航和定位。
发明内容
本发明的目的在于针对现有技术的不足,提供一种基于视觉的AGV巡线导航和定位方法。
本发明的目的是通过已经技术方案来实现的:一种基于视觉的AGV巡线导航和定位方法,该方法包括:
获得当前航向前方的图像;
根据导航标线的第一预设特征,从所述图像中识别出符合所述第一预设特征的导航标线对象;
获取AGV与导航标线的相对位置关系,并利用所述相对位置关系修正AGV的位置与航向,所述相对位置关系包括AGV与导航标线的距离、AGV当前航向与导航标线的夹角。
进一步地,所述第一预设特征为导航标线的颜色属性。
进一步地,所述导航标线设置于AGV行走路径的一侧或两侧。
进一步地,若识别到位于AGV两侧的导航标线,则确定跟踪路径为两侧的导航标线的中线;
若识别到位于AGV一侧的导航标线,则确定跟踪路径为一与导航标线平行且相距设定距离的直线;若未识别到导航标线,AGV根据里程计信息移动一段距离,若仍未检测到导航标线则停止移动;其中,所述跟踪路径为预设的AGV的行走路径。
进一步地,还包括利用导航标线与位置修正标记对AGV里程计信息进行修正,所述里程计信息包括里程计航向角信息和里程计位置信息。
进一步地,在对里程计信息进行修正前,从图像中识别出符合第二预设特征的位置修正标记对象,根据位置修正标记提供的位置信息修正里程计位置信息,所述第二预设特征区别于所述第一预设特征。
进一步地,所述第二预设特征为区别于导航标线颜色的颜色属性。
进一步地,计算AGV航向与导航标线之间的角度获得当前航向角信息,将里程计航向角信息修正为当前航向角信息。
进一步地,从所述图像中识别出符合所述第一预设特征的导航标线对象的步骤包括:
对图像进行预处理,包括图像去畸变和滤波处理;
利用直线提取算法提取预处理后的图像中的线段,融合线段,得到若干待筛选直线段;
采用基于高斯模型的直线筛选算法,从待筛选直线中筛选出目标直线,所述目标直线即为识别出的导航标线。
一种移动机器人,包括驱动装置、处理器、以及用于存储处理器可执行的指令的存储器;
所述处理器被配置为:
获得当前航向前方的图像;
根据导航标线的第一预设特征,从所述图像中识别出符合所述第一预设特征的导航标线对象;
获取AGV与导航标线的相对位置关系,
控制驱动装置根据所述相对位置关系修正AGV的位置与航向,
所述相对位置关系包括AGV与导航标线的距离、AGV当前航向与导航标线的夹角。
本发明的有益效果是:
1.本发明采用图像采集设备替代磁导引传感器,采用彩色胶带铺设辅助路径,极大的降低了导航路径改造和维护成本。针对图像采集设备感知视野小的缺点,通过融合视觉特征和里程计信息,准确的跟踪AGV的实时位姿。同时,针对可移动设备侧滑、脚轮打滑等原因导致的里程计累计误差,通过设置全局坐标已知的位置修正标记修正AGV的里程计信息,从而实现AGV高精度、稳定的定位和导航。
2.本发明通过观测到的地面路径信息,自动控制AGV与路径的距离和偏差角,实时路径跟踪。针对AGV工作环境对路径铺设的柔性具有较高要求,AGV的定位导航能力可应付不同路况,包括实现对双侧路径、单侧路径的定位和导航、对无路径状态下突发情况具有自主判断能力。
附图说明
图1是全局坐标系下AGV的位置坐标和图像坐标系下AGV的位置坐标转换关系;
图2是紫色标记点的全局坐标与AGV车体坐标的转换关系。
具体实施方式
实施例1
一种基于视觉的AGV巡线导航和定位方法,包括步骤:
步骤101:获得当前航向前方的图像;
在本实施例中,通过固定在AGV上的相机获取图像,相机光轴平行AGV的纵轴线,AGV的纵轴线方向与AGV航向的方向一致,相机经过内外部参数标定,所述内外参数包括相机焦距、畸变系数、相机高度、俯仰角、相机与AGV车体中心的相对位置关系等,以获得图像与全局坐标系的转换关系,相机坐标与AGV车体坐标的转换关系等。其中,所述AGV车体中心作为用于描述AGV轨迹运动的特征点。
其中,在获得当前航向前方的图像前构建工作环境的拓扑地图,设置拓扑节点,AGV在工作环境中可基于A*算法规划行走路径,行走路径由两个或若干个节点组成,相邻节点间可直线到达。需要说明的是,本发明的方法根据拓扑地图建立全局坐标系,设置拓扑节点,从而可获得节点的全局坐标。
在本实施例中,所述导航标线设置于行走路径的一侧或两侧。所述导航标线具有颜色属性,例如采用黄色胶带铺设在工作环境中,导航标线设置方式具有极大柔性,所述导航标线设置于行走路径的一侧或两侧,并且可采用局部无路径方式即间隔一定距离设置。导航标线上设置有若干紫色的修正标记。
步骤102:根据导航标线的第一预设特征,从所述图像中识别出符合所述第一预设特征的导航标线对象;所述第一预设特征根据现有的识别图像中的直线的技术而定,例如根据直线的颜色属性识别直线,根据图像中直线的梯度直方图特征识别直线等;
本实施例中,所述第一预设特征为导航标线的颜色属性,即导航标线具有特定的颜色,例如黄色,用于区别图像背景的颜色。具体过程为:
(1)对图像进行预处理,包括图像去畸变和滤波处理;
其中,图像中的导航标线具有特定颜色属性,对图像进行预处理,包括图像去畸变和滤波处理;并定义图像坐标系,以图像左上角的点为坐标原点,以像素为坐标单位:
(2)利用直线提取算法提取预处理后的图像中的线段,融合线段,得到若干待筛选直线段;所述融合是将处于同一条直线上或者近似同一条直线上的线段合并成一条直线段。
(3)采用基于高斯模型的直线筛选算法,从待筛选直线中筛选出目标直线,所述目标直线即为识别出的导航标线;
步骤103:获取AGV与导航标线的相对位置关系,并利用所述相对位置关系修正AGV的位置与航向。
其中,相对位置关系包括AGV与导航标线的距离、AGV当前航向与导航标线的夹角。在本实施例中,具体地,计算获得AGV与导航标线的距离,判断距离与跟踪路径的偏差,将AGV调整至跟踪路径上,所述跟踪路径为预设的AGV的行走路径;同时计算AGV航向与预设航向的偏差,将AGV航向调整至预设航向上。在本实施例中,采用凑试法确定PID控制器参数调整AGV航向角,并控制AGV与左右导航标线的距离,实现路径跟踪;
所述跟踪路径包括如下三种:
1、若识别到位于AGV两侧的导航标线,则确定跟踪路径为两侧的导航标线的中线;
2、若识别到位于AGV一侧的导航标线,则确定跟踪路径为一与导航标线平行且相距设定距离的直线;
通过现有技术从相邻时刻采集的两帧RGB图像判断当前导航标线位于AGV左侧或者右侧,控制AGV保持安全距离跟踪导航标线,所述安全距离即跟踪路径与导航标线的距离,该距离预先设置;
3、若未识别到导航标线,AGV根据里程计信息移动一段设定的距离,若仍未检测到导航标线则急停。
实施例2
在本实施例中,对步骤102的具体过程包括:
步骤201:使用直线提取算法提取预处理后的图像中的线段;
其中,所述线段包括如下属性:包含线段的起始点、终止点和线段长度。其中,所述线段包含起始点与终止点,并且起始点与终止点均在图像区域,或者以图像区域与线段的交点为终止点。
步骤202:选定两条线段分别作为母直线和子直线,并利用设定阈值判定母直线和子直线是否可以融合;若小于设定阈值则判定线段处于一条直线上可以融合;
具体地,选定一条线段作为母直线,子直线可以为除选定母直线外的任意线段,在一实施例中,通过线段长度的降序排列,有顺序地选择母直线和子直线,也可通过任意随机方式选择或者根据线段长度升序排列,再顺序选择母直线和子直线;
步骤203:对步骤S202中判定能融合的线段进行融合,得到融合后的直线段;
步骤204:重复步骤S202、S203,直到剩余直线段不能融合,得到若干待筛选直线段;
在本实施例中,将融合后的直线段与图像边缘的交点加入到各自的线段属性;所述线段属性包括线段的起始点、终止点和线段长,即将所述交点作为线段属性中线段的起始点、终止点;度。该步骤在每次步骤S203得到融合后的直线段后进行或者步骤S204直到剩余直线段不能融合后进行。
步骤205:对步骤S204中待筛选直线段进行评分,根据评分筛选出的目标直线即为导航标线;
实施例3,步骤102、步骤201中所述直线提取算法中优先选用LSD线段提取算法,
所述LSD线段提取算法包括以下子步骤:
步骤S301:计算每个像素点的梯度,并定义水平线方向为与梯度垂直的方向;
步骤S302:使用区域增长算法将图像分割为若干个连通域,每个连通域内允许两两像素之间水平线方向的最大差值为τ;
步骤S303:对于每一个连通域选取一个最小矩形包围该区域,则矩形的长轴方向为线段的方向,并返回线段的两个端点;用直线方程Ax+By+C=0表示步骤S201以及本发明中得到的每条线段,其中A,B,C为直线一般式的三个参数。该线段包括如下属性:线段的起始点、终止点和线段长度。
实施例4,
步骤202中选定母直线和子直线具体方式如下:
步骤S401:根据线段属性中的线段长度,对步骤201中得到的N条线段进行排序,长度依次递减;并设置直线融合标志,初始为0;
步骤S402:根据线段长度的排序选取母直线与子直线,以第i条直线为母直线,以第j条直线为子直线;
其中,选取母直线的步骤具体包括:
①初始取i的数值为1;
②若j大于N,i的值加一;
③若i大于N,判断直线融合标志是否为1,如果为1则重复步骤S301、S302、S303,否则计算直线与图像边缘的交点;
所述直线与图像边缘的交点表示为(xs,ys),(xe,ye),将两个交点加入到直线属性,即将两个交点作为线段属性中线段的起始点、终止点;
也可以在得到剩余的若干不能再融合的直线之后计算每条剩余直线与图像边缘的交点,并将两个交点加入各自的直线属性;
其中,选取子直线的步骤具体包括:
①初始取j的数值为i+1;
②若直线可以融合,融合后删除用于融合的子直线,设置直线融合标志为1,j的值不变,用第j+1条直线至第N条直线分别代替第j条直线至第N-1条直线,或者当直线不可融合时,j的值直接加1;
③若j大于N,则重复步骤S402;
实施例5
步骤202中选取母直线和子直线后,利用设定阈值判断母直线和子直线是否可以融合,所述设定阈值包括距离和阈值、角度差阈值和截距误差阈值,若小于设定阈值则可以融合;
具体过程如下:
(1)当子直线只包含一个线段:计算子直线的两个端点到母直线的距离和,若小于距离和阈值,则可以融合;
具体地,当子直线第j条直线只包含一个线段:使用如下公式判定两个线段端点(x1,y1),(x2,y2)与母直线第i条直线的距离和errdist;
errdist=D(x1,y1)+D(x2,y2)
其中:
Ai、Bi、Ci为母直线第i条直线的一般式参数,D(x,y)表示点(x,y)到母直线第i条直线的距离。
若errdist小于设定阈值,则判定母直线第i条直线与子直线第j条直线可以融合。
(2)当子直线包含多个线段:计算子直线与母直线角度差和截距误差同时小于设定的角度差阈值和截距误差阈值时,则判定子直线与母直线可以融合。
当第j条直线包含多个线段:子直线第j条直线的参数为Aj,Bj,Cj,则两条直线的角度差阈值为errangle:
截距误差为errC:
当errangle与errC同时小于设定的阈值时,则判定母直线第i条直线与子直线第j条直线可以融合;
实施例6
步骤S203对判定能融合的线段进行融合的方法为:对母直线与子直线中的每个线段采样;将所有采样点经过最小二乘拟合可以得到新的直线。
在本实施例中,对于母直线与子直线可能包含多个被融合的线段,分别对母直线第i条直线与子直线第j条直线中的每个线段采样;每个线段采样点的数目为线段长度值,此处以像素为单位,即如果线段长度占了100个像素点,则采样的点数为100,最终得到采样点数目为Li+Lj,其中s为直线中的线段数目,lm为第m条线段的长度;使用Li+Lj个采样点,经过最小二乘拟合可以得到新的直线,一般式参数为Af、Bf、Cf,使用Af、Bf、Cf更新母直线第i条直线中的一般式参数Ai、Bi、Ci,设置Li为Li+Lj,将子直线第j条直线中的线段加入到母直线第i条直线中;
实施例7,步骤204采用基于高斯模型的直线筛选算法,从待筛选直线中筛选出目标直线的具体过程为:
步骤S701:选取描述特征,所述描述特征为沿垂直于直线的方向所有对称的采样点颜色值差值的均值;
本实施例具体提取特征的方法如下:
设点为直线上的一点,其中t表示从(xs,ys)到(xe,ye)的第t个采样点;沿垂直于直线的方向,以为中心向两侧分别采样M个点,则所有采样点数目为2M,第k次采样得到的两个点表示为则定义:
其中RGB(x)表示x位置处的颜色值,f(x)为用于描述像素x的描述特征,为3×1特征向量;
步骤S702:训练高斯模型:选取位于目标直线上的点,提取步骤S701中的所述特征,提取高斯模型,得均值特征向量以及协方差矩阵;
具体地,选取位于目标直线上的点,提取步骤S701中的特征,得到包含n个特征的集合F={f1,f2...fn},为3×n矩阵;提取高斯模型,得均值特征向量为3×1特征向量,以及协方差矩阵cov,为3×3矩阵;
F中的每一列减去得到矩阵
将训练完毕的高斯模型保存为文件,方便步骤S703中筛选直线操作;如果需要筛选多种颜色特性的直线,则可以经过多次训练保存为多个高斯模型。
步骤S703:筛选直线:对于经过融合后的任意一条直线,对每一点提取步骤S701中所述特征;使用马氏距离度量每一点特征与步骤S702得到的高斯模型之间的距离计算得分,得到目标直线;所述目标直线即为识别出的导航标线。
具体地,对于经过融合后的任意一条直线,从起始点(xs,ys)到终止点(xe,ye),对每一点提取步骤S701中所述特征;对于点p得到的特征为f(p);使用马氏距离D(p)度量p点特征与步骤S702得到的高斯模型之间的距离:
从起始点(xs,ys)到终止点(xe,ye)采样点总数为Z,则该直线的得分S为:
S越小,则越接近需要的直线;若S小于设置阈值,则当前直线为目标直线,否则,当前直线不是目标直线。
实施例8
对于步骤103获取AGV与导航标线的相对位置关系,并利用所述相对位置关系修正AGV的位置与航向的具体过程为:
具体地,在全局坐标系下,获取AGV的位置坐标,以及导航标线的坐标,通过AGV的坐标与导航标线的坐标,计算得到AGV车体中心与左右导航标线的距离L1、L2,以及AGV航向与导航标线的夹角θ,具体地,如图1,根据标定结果获取相机的坐标,计算相机与左右导航标线的垂直距离l1、l2;根据相机标定的结果中相机与AGV车体中心的相对距离d计算图像坐标系下AGV的位置坐标;相机安装时光轴平行AGV纵轴线,相机与AGV车体中心的连线在AGV的航向上,因此当相机光轴的投影与导航标线的夹角θ时,AGV纵轴线与导航标线方向矢量的夹角为θ,根据公式(1)计算获得AGV与左右导航标线的直线距离L1、L2,公式(1)如下:
实施例9,对里程计信息进行修正
里程计信息包括里程计航向角信息和里程计位置信息,所述里程计航向角信息用于估计当前AGV航向,所述里程计位置信息用于估计AGV当前位置,会有累计误差,
本实施例中,计算AGV航向与导航标线之间的角度获得当前航向角信息,将里程计信息修正为当前航向角信息,即用当前航向角代替里程计航向角信息,图2中,路径中每条线段在拓扑地图中的角度已知,当前航向角β为航向与导航标线的夹角;在将里程计信息修正为当前航向角信息前比较当前航向角信息与里程计航向角信息的偏差值,超过阈值,则保持里程计航向角信息,也就是当前航向角信息与前一刻航向角信息的偏差太大,则认为定位失败,不对里程计的航向角信息进行修正。
本实施例中还用位置修正标记提供的位置修正信息代替里程计位置信息,具体地,从图像中识别出符合第二预设特征的修正标记对象,根据位置修正标记提供的位置信息修正里程计位置信息,本实施例中,采用粘贴在导航标线上的紫色标记作为位置修正标记,所述第二预设特征为区别于导航标线颜色属性的颜色,能够被相机识别,每个紫色标记对应一个坐标位置,设置紫色标记的全局坐标(a,b),利用公式(3)标定里程计全局坐标信息(X,Y),即将里程计位置信息修正为里程计全局坐标信息。其中,还可以利用公式(2)将紫色标记在图像坐标系坐标(x,y)转换为AGV车体坐标系坐标(u,v)。
x=v
y=-u (2)
Claims (10)
1.一种基于视觉的AGV巡线导航和定位方法,其特征在于:
获得当前航向前方的图像;
根据导航标线的第一预设特征,从所述图像中识别出符合所述第一预设特征的导航标线对象;
获取AGV与导航标线的相对位置关系,并利用所述相对位置关系修正AGV的位置与航向,所述相对位置关系包括AGV与导航标线的距离、AGV当前航向与导航标线的夹角。
2.根据权利要求1所述的方法,其特征在于,所述第一预设特征为导航标线的颜色属性。
3.根据权利要求1所述的方法,其特征在于,所述导航标线设置于AGV行走路径的一侧或两侧。
4.根据权利要求3所述的方法,其特征在于,
若识别到位于AGV两侧的导航标线,则确定跟踪路径为两侧的导航标线的中线;
若识别到位于AGV一侧的导航标线,则确定跟踪路径为一与导航标线平行且相距设定距离的直线;
若未识别到导航标线,AGV根据里程计信息移动一段距离,若仍未检测到导航标线则停止移动;
其中,所述跟踪路径为预设的AGV的行走路径。
5.根据权利要求1所述的方法,其特征在于,还包括利用导航标线与位置修正标记对AGV里程计信息进行修正,所述里程计信息包括里程计航向角信息和里程计位置信息。
6.根据权利要求5所述的方法,其特征在于,在对里程计信息进行修正前,从图像中识别出符合第二预设特征的位置修正标记对象,根据位置修正标记提供的位置信息修正里程计位置信息,所述第二预设特征区别于所述第一预设特征。
7.根据权利要求6所述的方法,其特征在于,所述第二预设特征为区别于导航标线颜色的颜色属性。
8.根据权利要求5所述的方法,其特征在于,计算AGV航向与导航标线之间的角度获得当前航向角信息,将里程计航向角信息修正为当前航向角信息。
9.根据权利要求2所述的方法,其特征在于,从所述图像中识别出符合所述第一预设特征的导航标线对象的步骤包括:
对图像进行预处理,包括图像去畸变和滤波处理;
利用直线提取算法提取预处理后的图像中的线段,融合线段,得到若干待筛选直线段;
采用基于高斯模型的直线筛选算法,从待筛选直线中筛选出目标直线,所述目标直线即为识别出的导航标线。
10.一种移动机器人,其特征在于,包括驱动装置、处理器、以及用于存储处理器可执行的指令的存储器;
所述处理器被配置为:
获得当前航向前方的图像;
根据导航标线的第一预设特征,从所述图像中识别出符合所述第一预设特征的导航标线对象;
获取AGV与导航标线的相对位置关系,
控制驱动装置根据所述相对位置关系修正AGV的位置与航向,
所述相对位置关系包括AGV与导航标线的距离、AGV当前航向与导航标线的夹角。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710261202.5A CN107121981A (zh) | 2017-04-20 | 2017-04-20 | 一种基于视觉的agv巡线导航和定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710261202.5A CN107121981A (zh) | 2017-04-20 | 2017-04-20 | 一种基于视觉的agv巡线导航和定位方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107121981A true CN107121981A (zh) | 2017-09-01 |
Family
ID=59724931
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710261202.5A Pending CN107121981A (zh) | 2017-04-20 | 2017-04-20 | 一种基于视觉的agv巡线导航和定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107121981A (zh) |
Cited By (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108107883A (zh) * | 2017-11-07 | 2018-06-01 | 浙江工业大学 | 一种基于磁带导引agv的多传感器信息融合定位方法 |
CN108197531A (zh) * | 2017-12-15 | 2018-06-22 | 海信集团有限公司 | 一种道路曲线检测方法、装置和终端 |
CN108227696A (zh) * | 2017-09-04 | 2018-06-29 | 河南森源电气股份有限公司 | 一种agv移动机器人的数学模型辨识方法及系统 |
CN108253956A (zh) * | 2017-12-29 | 2018-07-06 | 思博赛睿(北京)科技有限公司 | 一种智能捡网球机器人的定位系统、方法及装置 |
CN108520429A (zh) * | 2018-03-19 | 2018-09-11 | 北方民族大学 | 一种服务器和可应用于线下购物场所的导购系统 |
CN108665473A (zh) * | 2018-04-28 | 2018-10-16 | 北京航天自动控制研究所 | 一种视觉导引及视觉里程计复用方法 |
CN109032125A (zh) * | 2018-05-31 | 2018-12-18 | 上海工程技术大学 | 一种视觉agv的导航方法 |
CN109674404A (zh) * | 2019-01-26 | 2019-04-26 | 深圳市云鼠科技开发有限公司 | 一种基于free move技术的扫地机器人避障处理方式 |
CN109960145A (zh) * | 2017-12-22 | 2019-07-02 | 天津工业大学 | 移动机器人混合视觉轨迹跟踪策略 |
CN110308729A (zh) * | 2019-07-18 | 2019-10-08 | 石家庄辰宙智能装备有限公司 | 基于视觉与imu或里程计的agv组合导航定位方法 |
CN111240330A (zh) * | 2020-01-17 | 2020-06-05 | 电子科技大学 | 一种平粮机器人同步导航和精确定位方法及系统 |
CN111985436A (zh) * | 2020-08-29 | 2020-11-24 | 浙江工业大学 | 一种基于lsd的车间地标线识别拟合方法 |
CN112263188A (zh) * | 2020-10-22 | 2021-01-26 | 湖南格兰博智能科技有限责任公司 | 一种移动机器人行进方向的矫正方法及其设备 |
WO2021189627A1 (zh) * | 2020-03-23 | 2021-09-30 | 丰疆智能科技股份有限公司 | 基于视觉的室内导航系统和室内导航方法 |
CN114001738A (zh) * | 2021-09-28 | 2022-02-01 | 浙江大华技术股份有限公司 | 视觉巡线定位方法、系统以及计算机可读存储介质 |
CN114440892A (zh) * | 2022-01-27 | 2022-05-06 | 中国人民解放军军事科学院国防科技创新研究院 | 一种基于拓扑地图和里程计的自定位方法 |
CN115027862A (zh) * | 2022-07-11 | 2022-09-09 | 上海忍诚科技有限公司 | 一种自动分拣系统及自动分拣方法 |
CN115237111A (zh) * | 2021-04-25 | 2022-10-25 | 广东博智林机器人有限公司 | 导航控制方法、装置、铺贴机器人以及存储介质 |
CN115793656A (zh) * | 2022-12-09 | 2023-03-14 | 武汉大学 | 一种基于线路标志的轨道巡检机器人定位方法、装置及系统 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1438138A (zh) * | 2003-03-12 | 2003-08-27 | 吉林大学 | 自动引导车的视觉引导方法及其自动引导电动车 |
US20060064212A1 (en) * | 2004-09-22 | 2006-03-23 | Cycle Time Corporation | Reactive automated guided vehicle vision guidance system |
CN101561680A (zh) * | 2009-05-11 | 2009-10-21 | 南京航空航天大学 | 一种自主车辆的嵌入式导引装置及其智能复合导引方法 |
CN103292804A (zh) * | 2013-05-27 | 2013-09-11 | 浙江大学 | 一种单目自然视觉路标辅助的移动机器人定位方法 |
KR101318560B1 (ko) * | 2012-02-29 | 2013-10-16 | 부산대학교 산학협력단 | 유도라인 추적 agv의 유연한 주행 제어를 위한 영상 기반 유도라인 해석 방법 |
CN104864889A (zh) * | 2015-05-29 | 2015-08-26 | 山东鲁能智能技术有限公司 | 一种基于视觉的机器人里程计校正系统及方法 |
CN105136153A (zh) * | 2015-09-11 | 2015-12-09 | 江苏大学 | 一种车道线精确位置采集装置以及采集方法 |
CN105716611A (zh) * | 2016-01-29 | 2016-06-29 | 西安电子科技大学 | 基于环境信息的室内移动机器人及其定位方法 |
-
2017
- 2017-04-20 CN CN201710261202.5A patent/CN107121981A/zh active Pending
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1438138A (zh) * | 2003-03-12 | 2003-08-27 | 吉林大学 | 自动引导车的视觉引导方法及其自动引导电动车 |
US20060064212A1 (en) * | 2004-09-22 | 2006-03-23 | Cycle Time Corporation | Reactive automated guided vehicle vision guidance system |
CN101561680A (zh) * | 2009-05-11 | 2009-10-21 | 南京航空航天大学 | 一种自主车辆的嵌入式导引装置及其智能复合导引方法 |
KR101318560B1 (ko) * | 2012-02-29 | 2013-10-16 | 부산대학교 산학협력단 | 유도라인 추적 agv의 유연한 주행 제어를 위한 영상 기반 유도라인 해석 방법 |
CN103292804A (zh) * | 2013-05-27 | 2013-09-11 | 浙江大学 | 一种单目自然视觉路标辅助的移动机器人定位方法 |
CN104864889A (zh) * | 2015-05-29 | 2015-08-26 | 山东鲁能智能技术有限公司 | 一种基于视觉的机器人里程计校正系统及方法 |
CN105136153A (zh) * | 2015-09-11 | 2015-12-09 | 江苏大学 | 一种车道线精确位置采集装置以及采集方法 |
CN105716611A (zh) * | 2016-01-29 | 2016-06-29 | 西安电子科技大学 | 基于环境信息的室内移动机器人及其定位方法 |
Non-Patent Citations (1)
Title |
---|
郭宝青: "基于图像特征的列车自主定位方法研究", 《中国博士学位论文全文数据库 信息科技辑》 * |
Cited By (27)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108227696A (zh) * | 2017-09-04 | 2018-06-29 | 河南森源电气股份有限公司 | 一种agv移动机器人的数学模型辨识方法及系统 |
CN108107883A (zh) * | 2017-11-07 | 2018-06-01 | 浙江工业大学 | 一种基于磁带导引agv的多传感器信息融合定位方法 |
CN108197531A (zh) * | 2017-12-15 | 2018-06-22 | 海信集团有限公司 | 一种道路曲线检测方法、装置和终端 |
CN108197531B (zh) * | 2017-12-15 | 2021-02-05 | 海信集团有限公司 | 一种道路曲线检测方法、装置和终端 |
CN109960145A (zh) * | 2017-12-22 | 2019-07-02 | 天津工业大学 | 移动机器人混合视觉轨迹跟踪策略 |
CN109960145B (zh) * | 2017-12-22 | 2022-06-14 | 天津工业大学 | 移动机器人混合视觉轨迹跟踪策略 |
CN108253956A (zh) * | 2017-12-29 | 2018-07-06 | 思博赛睿(北京)科技有限公司 | 一种智能捡网球机器人的定位系统、方法及装置 |
CN108253956B (zh) * | 2017-12-29 | 2021-04-23 | 董明武 | 一种智能捡网球机器人的定位系统、方法及装置 |
CN108520429A (zh) * | 2018-03-19 | 2018-09-11 | 北方民族大学 | 一种服务器和可应用于线下购物场所的导购系统 |
CN108665473A (zh) * | 2018-04-28 | 2018-10-16 | 北京航天自动控制研究所 | 一种视觉导引及视觉里程计复用方法 |
CN108665473B (zh) * | 2018-04-28 | 2020-11-10 | 北京航天自动控制研究所 | 一种视觉导引及视觉里程计复用方法 |
CN109032125A (zh) * | 2018-05-31 | 2018-12-18 | 上海工程技术大学 | 一种视觉agv的导航方法 |
CN109674404A (zh) * | 2019-01-26 | 2019-04-26 | 深圳市云鼠科技开发有限公司 | 一种基于free move技术的扫地机器人避障处理方式 |
CN110308729A (zh) * | 2019-07-18 | 2019-10-08 | 石家庄辰宙智能装备有限公司 | 基于视觉与imu或里程计的agv组合导航定位方法 |
CN111240330A (zh) * | 2020-01-17 | 2020-06-05 | 电子科技大学 | 一种平粮机器人同步导航和精确定位方法及系统 |
CN111240330B (zh) * | 2020-01-17 | 2021-03-23 | 电子科技大学 | 一种平粮机器人同步导航和精确定位方法及系统 |
WO2021189627A1 (zh) * | 2020-03-23 | 2021-09-30 | 丰疆智能科技股份有限公司 | 基于视觉的室内导航系统和室内导航方法 |
CN111985436A (zh) * | 2020-08-29 | 2020-11-24 | 浙江工业大学 | 一种基于lsd的车间地标线识别拟合方法 |
CN111985436B (zh) * | 2020-08-29 | 2024-03-12 | 浙江工业大学 | 一种基于lsd的车间地标线识别拟合方法 |
CN112263188A (zh) * | 2020-10-22 | 2021-01-26 | 湖南格兰博智能科技有限责任公司 | 一种移动机器人行进方向的矫正方法及其设备 |
CN115237111A (zh) * | 2021-04-25 | 2022-10-25 | 广东博智林机器人有限公司 | 导航控制方法、装置、铺贴机器人以及存储介质 |
CN114001738A (zh) * | 2021-09-28 | 2022-02-01 | 浙江大华技术股份有限公司 | 视觉巡线定位方法、系统以及计算机可读存储介质 |
CN114440892A (zh) * | 2022-01-27 | 2022-05-06 | 中国人民解放军军事科学院国防科技创新研究院 | 一种基于拓扑地图和里程计的自定位方法 |
CN114440892B (zh) * | 2022-01-27 | 2023-11-03 | 中国人民解放军军事科学院国防科技创新研究院 | 一种基于拓扑地图和里程计的自定位方法 |
CN115027862A (zh) * | 2022-07-11 | 2022-09-09 | 上海忍诚科技有限公司 | 一种自动分拣系统及自动分拣方法 |
CN115793656A (zh) * | 2022-12-09 | 2023-03-14 | 武汉大学 | 一种基于线路标志的轨道巡检机器人定位方法、装置及系统 |
CN115793656B (zh) * | 2022-12-09 | 2023-08-25 | 武汉大学 | 一种基于线路标志的轨道巡检机器人定位方法、装置及系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107121981A (zh) | 一种基于视觉的agv巡线导航和定位方法 | |
CN106774313B (zh) | 一种基于多传感器的室外自动避障agv导航方法 | |
Li et al. | Openstreetmap-based autonomous navigation for the four wheel-legged robot via 3d-lidar and ccd camera | |
CN107727104B (zh) | 结合标识的同时定位和地图创建导航方法、装置及系统 | |
US11009884B2 (en) | Method for calculating nominal vehicle paths for lanes within a geographic region | |
CN106407315B (zh) | 一种基于街景图像数据库的车辆自主定位方法 | |
CN106291278B (zh) | 一种基于多视觉系统的开关柜局部放电自动检测方法 | |
CN110262508A (zh) | 应用于封闭场地无人驾驶货运车辆上的自动引导系统及方法 | |
CN109885084A (zh) | 一种基于单目视觉和模糊控制的多旋翼无人机自主降落方法 | |
CN107085938B (zh) | 基于车道线与gps跟随的智能驾驶局部轨迹容错规划方法 | |
CN106444780A (zh) | 一种基于视觉定位算法的机器人的自主导航方法及系统 | |
CN109410301A (zh) | 面向无人驾驶汽车的高精度语义地图制作方法 | |
CN107422730A (zh) | 基于视觉导引的agv运输系统及其驾驶控制方法 | |
CN106647814A (zh) | 一种基于二维码地标识别的无人机视觉辅助定位与飞控系统及方法 | |
CN107167139A (zh) | 一种变电站巡检机器人视觉定位导航方法及系统 | |
CN105867379A (zh) | 一种机器人的运动控制方法及控制系统 | |
Yuan et al. | RGB-D sensor-based visual SLAM for localization and navigation of indoor mobile robot | |
CN106873630A (zh) | 一种飞行控制方法及装置,执行设备 | |
CN106441286A (zh) | 基于bim技术的无人机隧道巡检系统 | |
CN107992829A (zh) | 一种交通信号灯车道级控制关系提取方法及装置 | |
CN108045435A (zh) | 一种路面自适应的智能车辆横向混合控制方法 | |
CN105809106B (zh) | 基于机器视觉的车辆队形跟驰检测方法 | |
CN109683629A (zh) | 基于组合导航和计算机视觉的无人机电力架线系统 | |
WO2016013095A1 (ja) | 自律移動装置 | |
CN107402018A (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 | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20170901 |