CN105955259B - 基于多窗口实时测距的单目视觉agv的精确定位方法 - Google Patents
基于多窗口实时测距的单目视觉agv的精确定位方法 Download PDFInfo
- Publication number
- CN105955259B CN105955259B CN201610286380.9A CN201610286380A CN105955259B CN 105955259 B CN105955259 B CN 105955259B CN 201610286380 A CN201610286380 A CN 201610286380A CN 105955259 B CN105955259 B CN 105955259B
- Authority
- CN
- China
- Prior art keywords
- agv
- image
- window
- multiwindow
- real time
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 43
- 238000005259 measurement Methods 0.000 claims abstract description 26
- 239000000284 extract Substances 0.000 claims abstract description 8
- 238000009434 installation Methods 0.000 claims abstract description 7
- 230000033001 locomotion Effects 0.000 claims description 16
- 238000012545 processing Methods 0.000 claims description 14
- 238000000605 extraction Methods 0.000 claims description 10
- 238000013507 mapping Methods 0.000 claims description 8
- 230000000007 visual effect Effects 0.000 claims description 8
- 238000001514 detection method Methods 0.000 claims description 4
- 238000006073 displacement reaction Methods 0.000 claims description 4
- 230000000295 complement effect Effects 0.000 claims description 3
- 238000013461 design Methods 0.000 claims description 3
- 238000002474 experimental method Methods 0.000 claims description 3
- 238000005286 illumination Methods 0.000 claims description 3
- 238000000691 measurement method Methods 0.000 claims description 3
- 230000011218 segmentation Effects 0.000 claims description 3
- 238000007781 pre-processing Methods 0.000 claims description 2
- 230000008447 perception Effects 0.000 abstract 1
- 230000000694 effects Effects 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- PCTMTFRHKVHKIS-BMFZQQSSSA-N (1s,3r,4e,6e,8e,10e,12e,14e,16e,18s,19r,20r,21s,25r,27r,30r,31r,33s,35r,37s,38r)-3-[(2r,3s,4s,5s,6r)-4-amino-3,5-dihydroxy-6-methyloxan-2-yl]oxy-19,25,27,30,31,33,35,37-octahydroxy-18,20,21-trimethyl-23-oxo-22,39-dioxabicyclo[33.3.1]nonatriaconta-4,6,8,10 Chemical compound C1C=C2C[C@@H](OS(O)(=O)=O)CC[C@]2(C)[C@@H]2[C@@H]1[C@@H]1CC[C@H]([C@H](C)CCCC(C)C)[C@@]1(C)CC2.O[C@H]1[C@@H](N)[C@H](O)[C@@H](C)O[C@H]1O[C@H]1/C=C/C=C/C=C/C=C/C=C/C=C/C=C/[C@H](C)[C@@H](O)[C@@H](C)[C@H](C)OC(=O)C[C@H](O)C[C@H](O)CC[C@@H](O)[C@H](O)C[C@H](O)C[C@](O)(C[C@H](O)[C@H]2C(O)=O)O[C@H]2C1 PCTMTFRHKVHKIS-BMFZQQSSSA-N 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000003032 molecular docking Methods 0.000 description 1
- 238000000465 moulding Methods 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/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Multimedia (AREA)
- Electromagnetism (AREA)
- Aviation & Aerospace Engineering (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Traffic Control Systems (AREA)
- Image Analysis (AREA)
- Image Processing (AREA)
Abstract
本发明公开了基于多窗口实时测距的单目视觉导引AGV的精确定位方法及系统，针对摄像机倾斜安装的方式，对相机参数进行标定与测量，建立视觉系统实时测量模型；通过在地面设置圆形色块作为停车定位的参照物，经过视觉系统的高效算法对其进行识别，精确提取其中心位置信息；在视野范围内，设置多窗口对图像进行处理：远端窗口用于AGV对地面信息的预判，使其逐渐减速；中间窗口作为粗定位窗口，对其位姿进行调整；近端窗口用于精确测距，准确停车；本方法实现了AGV对深度信息的感知，具有特征识别率高、算法实时性优、成本低廉、可扩展性强等优点，AGV停车的水平距离偏差稳定在±1mm、角度偏差稳定在±1°、停车误差稳定在±2mm。
Description
技术领域
本发明涉及一种基于视觉传感的工业移动机器人的精确定位技术，特别涉及一种基于多窗口实时测距的单目视觉导引AGV的精确定位方法及系统，其属于智能化工业机器人领域。
背景技术
在自动化物流装备中，自动导引车自动导引车AGV(Automated Guided Vehicle)作为物料运载的理想工具，已经应用于社会生产的多种行业。AGV在运行过程中，对其行走定位的精度要求不高，但在工位点处要求其能实现较高的定位停车精度。AGV的定位停车是指其导引系统在获取工位点信息后，能够在指定工位点处进行停车的功能，定位停车的位置准确与否将直接影响后续的工作任务。目前磁导引AGV的成本较低，但定位精度较差，激光导引AGV 的定位精度能达到5mm之内，但其成本较高。而视觉导引AGV以其精度高、实时性好、成本低等优点，越来越受到国内外学者的关注。
视觉导引AGV的摄像机安装方式有垂直安装与倾斜安装两种。公开号为CN103390259A 的中国发明专利采用一种摄像机垂直安装检测地面路径的方式，摄像机垂直安装图像畸变相对较小，检测精度高，但其视野小，无法及时获取AGV前方路况信息。公开号为CN103646249A 的中国发明专利采用摄像机倾斜安装方式，通过对采集的图像进行处理后得到前方路径中点信息，无法实现对路面信息的精确测量。
传统的单目视觉导引AGV不具备实时测距功能，缺少视觉信息反馈，不具备停车闭环控制的能力。此外，采用十字标记作为工位点信息的方法只是检测到工位点就立即发送停车信号给运动控制器，实际停车误差较大，重复停车定位精度低，不能实现AGV的精确定位停车。公开号为CN104181920A的中国发明专利提出的视觉定位方法能够实现AGV在工位点处的定位，但定位停车时易受到其他因素的影响，其停车定位精度并不理想。在路径偏差测量方面，传统的方法根据预先设定的路径模型对采集的路径点进行拟合，典型的路径模型有直线模型、圆弧模型以及非圆弧模型等，这类方法计算量大，并且精度相比直线模型计算出来的结果提升有限。
因此，确实有必要对现有技术进行改进以解决现有技术之不足。
发明内容
针对上述现有技术的不足，本发明提供一种基于多窗口实时测距的单目视觉导引AGV 的精确定位方法及系统，能够实现AGV在工位点处的精确定位与准确停车。
本发明提供的基于多窗口实时测距的单目视觉AGV的精确定位方法，步骤如下：
步骤一，建立视觉系统模型：采用前置倾斜安装车载摄像机的方式，通过简化单目视觉系统模型，利用几何方法推导出路面坐标系与图像像平面坐标系之间的转换关系，建立实时测距模型；
步骤二，在视野范围内，设置多窗口进行处理：将采集到的图像信息划分多个窗口：远端窗口始终用于自动导引车自动导引车AGV对地面信息的预判；中间窗口作为粗测量窗口，提取路径信息，实时测量停车标识中心与所述AGV的距离信息；近端窗口用于对所述AGV 的精确测距，准确停车；
步骤三，图像特征提取：设置地面特征识别窗口，设计基于嵌入式系统对采集图像进行处理，提取有用信息；其具体步骤为：(1)地面导引路径的原始图像采集；(2)图像预处理及二值化；(3)路径信息的采集；(4)圆形标识的检测与识别；(5)圆形标识的定位；
步骤四，路径偏差测量：将导引路径简化成直线模型，计算相对于图像像平面坐标系的位置偏差和姿态角偏差，并将所述偏差信号发送给车载控制器；
步骤五，作为粗定位窗口，根据提取到的路径信息对所述AGV的位姿进行调整，同时实时测量停车标识中心与所述AGV的距离信息，并将其反馈给运动控制器；(3)设定阈值，当在近端窗口测量的距离达到预先设定好的阈值范围时，则运动控制器发出停车信号进行停车。
进一步的，所述步骤一中建立视觉系统模型具体如下：将单目倾斜摄像机系统简化为简单几何模型，通过模型的几何关系推导出图像平面坐标与路平面坐标之间的映射关系，其映射关系如下：
其中
其中PQ为摄像机视野中心点到摄像机视野最下端的实际物理距离，L和W分别为图像平面的长和宽(即CCD的物理尺寸)；h为摄像机的安装高度；2β0为摄像机的水平视场角；2α0为摄像机的垂直视场角；γ为摄像机的俯仰角；即建立了实时测距的理论模型，实现视觉系统的实时测量功能。
进一步的，所述步骤三中图像特征提取具体包括：
步骤3.1：车载摄像机采集路径特征识别窗口中导引路径的原始图像，嵌入式平台将其处理为灰度图像，对均值滤波后的灰度图像进行光照补偿，以光照中心为基准按照距离信息划分为不同区域，对高光区域进行补色，对低照度区域进行补光，对每个区域采用最优阈值法确定分割阈值，得到二值化的路径特征图像。
步骤3.2：识别圆形标识：根据基于椭圆几何特征的边界追踪算法，获取目标的理想边缘；采用较大观测窗口对理想边缘进行曲率角估计，剔除非理想轮廓边缘，通常情况下，曲率角的极值出现在椭圆轮廓的顶点处；
步骤3.3：确定圆形标识的图像坐标：根据标准椭圆的几何特征，相互平行的椭圆弦，弦中点在同一条直线上，且椭圆的中心位于该条直线上；采用最小二乘拟合弦中点直线的椭圆中心定位的方法，拟合出水平弦中点和竖直弦中点所在的两条直线，求出其交点，即椭圆中心的坐标，通过实时测距模型，计算该交点在路面坐标系中的坐标，实现所述AGV对停车标识的距离精确感知。
进一步的，所述步骤四中路径偏差测量方法为：通过逐行扫描方法，计算路径导引窗口上边界和下边界的中点，作为导引路径的直线模型，采用最小二乘法计算相对于导引路径的姿态角偏差Δθ和位置偏差Δx为：
其中xi和yi为所采集图像的第i行(i＝0,1,2,3,…,n)路径中点的像素坐标，n的大小一般推荐范围为[80,159]。
进一步的，所述的步骤五具体包括：
步骤5.1：圆形标识进入到图像远端窗口，AGV减至较低速度，根据提取到的路径信息对所述AGV的位姿进行调整；
步骤5.2：圆形标识进入图像中间窗口，对其中心坐标进行提取，实时测量停车标识中心与AGV的距离信息，反馈给运动控制系统，将AGV继续减至更低速；
步骤5.3：圆形标识进入图像近端窗口，当测量得到的距离在预先设定好的阈值范围内时，运动控制器发出停车信号，所述AGV停车。
更进一步的，通过手眼标定实验得到的摄像机内外参数、摄像机的水平视场角和垂直视场角、摄像机的俯仰角、摄像机安装的离地高度参数，将其代入映射关系中。
本发明还提供一种基于多窗口实时测距的单目视觉导引AGV的精确定位系统，该系统包括车载摄像机、图像处理模块、运动控制模块、全方位移动平台；
所述车载摄像机连接至所述图像处理模块，并将视频传输至图像处理模块；所述图像处理模块连接至运动控制模块，将处理后的位置信息发送至运动控制模块；对全方位移动平台进行运动控制，实现AGV的精确定位。
所述车载CCD摄相机采集逐行倒相(Phase Alternating Line，PAL)制式的视频信号，图像分辨率为720×480，将图像序列输入嵌入式开发平台，经解码器解码处理后，输出8位 BT.601YCbCr格式彩色图像至以DSP为核心的图像处理平台，将处理得到的路径偏差和圆形标识的坐标信息以串口方式发送至以主控芯片STM32为核心的运动控制模块，进而对全方位移动平台进行运动控制，实现AGV的精确定位。
进一步的，所述图像处理模块为基于DSP和ARM的图像处理模块，所述运动控制模块为基于STM32的运动控制模块，所述全方位移动平台为基于麦克纳姆轮的全方位移动平台。
本发明采用以上技术方案与现有技术相比，具有以下技术效果：
本发明提供了一种基于多窗口实时测距的单目视觉导引AGV的精确定位方法及系统，实现AGV的实时测距功能，该方法可以用于简单障碍物的测距，实现AGV的合理避障；通过识别间隔距离一定的椭圆标识，设计简易的视觉里程计；AGV在非接触充电工位点处的准确停车，实现自动充电功能。
在行车、定位、停车过程中，设置多窗口对图像进行处理：远端窗口用于AGV对地面信息的预判，若检测到椭圆标识，则其减至一定速度；中间窗口作为粗定位窗口，根据提取到的路径信息对AGV的位姿进行调整，同时实时测量停车标识中心与AGV的距离信息；近端窗口用于AGV的精确测距，准确停车。
实现了AGV在工位点的准确停车，并将精度控制在±2mm之内。使AGV能够更精确的完成装运和卸载任务。
利用视觉传感系统，自动识别地面标识，相机参数进行标定与测量，从而建立视觉系统实时测量模型。通过在地面设置圆形色块作为停车定位的参照物，经过视觉系统的高效算法对其进行识别，精确提取其中心位置信息。本发明具有特征提取准确、系统实时性好、路径测量精度高以及停车定位精确平稳等优点。
附图说明
以下将结合附图对本发明作进一步说明：
图1为本发明一种基于多窗口实时测距的单目视觉导引AGV的精确定位方法及系统流程图；
图2为本发明单目倾斜视觉系统简化模型图；
图3为本发明单目倾斜视觉系统Y轴方向投影关系图；
图4为本发明二值化后路径特征图；
图5为本发明椭圆边缘提取方法的处理结果图；
图6为本发明椭圆边缘曲率角分布图；
图7为本发明椭圆中心坐标提取示意图；
图8为本发明图像多窗口分割处理示意图；
图9为本发明导引扫描窗口中直线模型计算偏差定义图。
具体实施方式
本发明提供基于多窗口实时测距的单目视觉AGV的精确定位方法及系统，为使本发明的目的，技术方案及效果更加清楚，明确，以及参照附图并举实例对本发明进一步详细说明。应当理解，此处所描述的具体实施仅用以解释本发明，并不用于限定本发明。
图1为本发明提供的一种基于多窗口实时测距的单目视觉导引AGV的精确定位方法及系统流程图。
1)视觉系统模型：使用低成本的车载摄像机，采用前置倾斜安装的方式，通过简化单目视觉系统模型，利用几何方法推导出路面坐标系与图像像平面坐标系之间的转换关系，建立实时测距模型，如图2所示；
2)在视野范围内，设置多窗口进行处理：将采集到的图像信息划分多个窗口：远端窗口始终用于AGV对地面信息的预判；中间窗口作为粗测量窗口，提取路径信息，实时测量停车标识中心与AGV的距离信息；近端窗口用于AGV的精确测距，准确停车。如图8所示，其各个窗口的大小根据车载摄像机的视角以及倾斜安装角度进行模拟实验确定；
3)图像特征提取：设置地面特征识别窗口，设计基于嵌入式系统的高效算法对采集图像进行处理，提取有用信息，具体步骤：(1)原始图像采集；(2)图像预处理及二值化；(3) 路径信息的提取；(4)圆形标识的检测与识别；(5)圆形标识的定位；
4)路径偏差测量：将导引路径简化成直线模型，计算相对于图像像平面坐标系的位置偏差和姿态角偏差，并将所述偏差信号发送给车载控制器；
5)精确停车：当远端窗口检测到椭圆标识，则其减至一定速度，约为0.1m/s；椭圆进入到中间窗口，根据提取到的路径信息对AGV的位姿进行调整，同时实时测量停车标识中心与AGV的距离信息，并将其反馈给运动控制器，将AGV速度降至更低，约为0.03m/s；当在近端窗口测量的距离达到预先设定好的阈值范围时，则运动控制器发出停车信号进行停车。
其中视觉系统模型方法包括：
将单目倾斜摄像机系统简化为简单几何模型，通过模型的几何关系推导出图像平面坐标与路平面坐标之间的映射关系，其映射关系如下：
其中
其中PQ为摄像机视野中心点到摄像机视野最下端的实际物理距离，L和W分别为图像平面的长和宽(即CCD的物理尺寸)；h为摄像机的安装高度；2β0为摄像机的水平视场角；2α0为摄像机的垂直视场角；γ为摄像机的俯仰角。
在此基础上，进行手眼标定实验，得到的相机内外参数、相机的水平视场角和垂直视场角、相机的俯仰角(安装时的倾斜角)、相机安装的离地高度等参数，将其代入映射关系中。可以实现AGV视觉系统对地面信息的实时相对测量。整个模型示意图如图3所示。
平面ABCD表示AGV行进路面，且该区域为摄像机视野范围内路面的梯形区域，O点为摄像机镜头中心点，OQ为摄像机的光轴，Q点为摄像机光轴和路面的交点，H点为O点在路面上的垂直投影。以Q点为路面坐标系的原点，X轴方向平行于AD，Y轴的方向与X 轴方向垂直，分别与AD、BC相交于点P、Q，路面坐标系统任意一点记为T(XT,YT)。
所述步骤3)，具体分为：
步骤1：车载摄像机采集路径特征识别窗口中导引路径的原始图像，嵌入式平台将其处理为灰度图像。由于光源的影响，图像光照中心亮度较高，边缘则较暗。故对均值滤波后的灰度图像进行光照补偿，以光照中心(标定得到)为基准按照距离信息划分为3个区域，对高光区域进行补色，对低照度区域进行补光，对每个区域采用最优阈值法确定分割阈值，得到二值化的路径特征图像，如图4所示。
步骤2：识别圆形标识：根据一种基于椭圆几何特征的边界追踪算法，获取目标的理想边缘，如图5所示。采用较大观测窗口对理想边缘进行曲率角估计，剔除非理想轮廓边缘，通常情况下，曲率角的极值出现在椭圆轮廓的4个顶点处，如图6所示；
步骤3：确定圆形标识的图像坐标：根据标准椭圆的几何特征，相互平行的椭圆弦，弦中点在同一条直线上，且椭圆的中心位于该条直线上。采用一种基于最小二乘拟合弦中点直线的椭圆中心定位的方法，拟合出水平弦中点和竖直弦中点所在的两条直线，求出其交点(即椭圆中心)的坐标，如图7所示。通过实时测距模型，可准确计算该交点在路面坐标系中的坐标，实现AGV对停车标识的距离精确感知。
所述步骤4)中路径偏差测量方法为：通过逐行扫描方法，计算路径导引窗口上边界和下边界的中点，作为导引路径的直线模型，如图9所示。采用最小二乘法计算相对于导引路径的姿态角偏差Δθ和位置偏差Δx为：
其中xi和yi为所采集图像的第i行(i＝0,1,2,3,…,n)路径中点的像素坐标，n的大小一般推荐范围为[80,159]。
进一步的所述的步骤5)具体包括：
步骤5.1：圆形标识进入到图像远端窗口，AGV减至一定速度，根据提取到的路径信息对AGV的位姿进行调整；
步骤5.2：圆形标识进入图像中间窗口，对其中心坐标进行提取，实时测量停车标识中心与AGV的距离信息，反馈给运动控制系统，将AGV继续减至低速；
步骤5.3：圆形标识进入图像近端窗口，当测量得到的距离在预先设定好的阈值范围内时，运动控制器发出停车信号，AGV停车。
同时，本发明还提供了一种基于多窗口实时测距的单目视觉导引AGV的精确定位系统，其中包括低成本的车载摄像机、基于DSP和ARM的图像处理模块、基于STM32的运动控制模块、基于麦克纳姆轮的全方位移动平台，所述车载摄像机自动将视频传输至基于DSP和ARM的图像处理模块，将处理后的位置信息通过RS232串口发送至基于STM32的运动控制模块，进而对基于麦克纳姆轮的全方位移动平台进行运动控制，实现AGV的精确定位。
以上所述仅是本发明的优选实施方式，应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明原理的前提下还可以作出若干改进，这些改进也应视为本发明的保护范围。
Claims (6)
1.基于多窗口实时测距的单目视觉导引AGV的精确定位方法，其特征在于，
步骤如下：
步骤一，建立视觉系统模型：采用前置倾斜安装车载摄像机的方式，通过简化单目视觉系统模型，利用几何方法推导出路面坐标系与图像像平面坐标系之间的转换关系，建立实时测距模型；
步骤二，在视野范围内，设置多窗口进行处理，将采集到的图像信息划分多个窗口：图像远端窗口始终用于自动导引车AGV对地面信息的预判；图像中间窗口作为粗定位窗口，提取路径信息，实时测量停车标识中心与所述AGV的距离信息；图像近端窗口用于对所述AGV的精确测距，准确停车；所述各个窗口的大小根据车载摄像机的视角以及倾斜安装角度进行模拟实验确定；
步骤三，图像特征提取：设置地面特征识别窗口，设计基于嵌入式系统对采集图像进行处理，提取有用信息；其具体步骤为：1)导引路径的原始图像采集；2)图像预处理及二值化；3)路径信息的采集；4)进行椭圆标识的检测与识别；5)椭圆标识的定位；
步骤四，路径偏差测量：将导引路径简化成直线模型，计算相对于图像像平面坐标系的位置偏差和姿态角偏差，并将偏差信号发送给车载控制器；
步骤五，精确停车：1)图像远端窗口若检测到椭圆标识，则其减至较低的速度；2)图像中间窗口作为粗定位窗口，根据提取到的路径信息对所述AGV的位姿进行调整，同时实时测量停车标识中心与所述AGV的距离信息，并将其反馈给运动控制器；3)设定阈值，当在图像近端窗口测量的距离达到预先设定好的阈值范围时，则运动控制器发出停车信号进行停车。
2.如权利要求1所述的基于多窗口实时测距的单目视觉导引AGV的精确定位方法，其特征在于：所述步骤一中建立视觉系统模型具体如下：将单目倾斜摄像机系统简化为简单几何模型，通过模型的几何关系推导出图像平面坐标与路平面坐标之间的映射关系，其映射关系如下：
其中
其中PQ为摄像机视野中心点到摄像机视野最下端的实际物理距离，L和W分别为图像平面的长和宽，即CCD的物理尺寸；h为摄像机的安装高度；2β0为摄像机的水平视场角；2α0为摄像机的垂直视场角；γ为摄像机的俯仰角；
即建立了实时测距的理论模型，实现视觉系统的实时测量功能。
3.如权利要求1所述的基于多窗口实时测距的单目视觉导引AGV的精确定位方法，其特征在于：所述步骤三中图像特征提取具体包括：
步骤3.1：车载摄像机采集地面特征识别窗口中导引路径的原始图像，嵌入式平台将其处理为灰度图像，对均值滤波后的灰度图像进行光照补偿，以光照中心为基准按照距离信息划分为不同区域，对高光区域进行补色，对低照度区域进行补光，对每个区域采用最优阈值法确定分割阈值，得到二值化的地面特征图像；
步骤3.2：识别椭圆标识：根据基于椭圆几何特征的边界追踪算法，获取目标的理想边缘；采用较大观测窗口对理想边缘进行曲率角估计，剔除非理想轮廓边缘，曲率角的极值出现在椭圆轮廓的顶点处；
步骤3.3：确定椭圆标识的图像坐标：根据标准椭圆的几何特征，相互平行的椭圆弦，弦中点在同一条直线上，且椭圆的中心位于所示条直线上；采用最小二乘拟合弦中点直线的椭圆中心定位的方法，拟合出水平弦中点和竖直弦中点所在的两条直线，求出其交点，即椭圆中心的坐标，通过实时测距模型，计算该交点在路面坐标系中的坐标，实现所述AGV对停车标识的距离精确感知。
4.如权利要求1所述的基于多窗口实时测距的单目视觉导引AGV的精确定位方法，其特征在于：所述步骤四中路径偏差测量方法为：通过逐行扫描方法，计算路径导引窗口上边界和下边界的中点，作为导引路径的直线模型，采用最小二乘法计算相对于导引路径的姿态角偏差Δθ和位置偏差Δx为：
其中xi和yi为所采集图像的第i行路径中点的像素坐标，i＝0,1,2,3,…,n。
5.如权利要求1所述的基于多窗口实时测距的单目视觉导引AGV的精确定位方法，其特征在于：所述的步骤五具体包括：
步骤5.1：椭圆标识进入到图像远端窗口，AGV减至较低速度，根据提取到的路径信息对所述AGV的位姿进行调整；
步骤5.2：椭圆标识进入图像中间窗口，对其中心坐标进行提取，实时测量停车标识中心与AGV的距离信息，反馈给运动控制系统，将AGV继续减至更低速；
步骤5.3：椭圆标识进入图像近端窗口，当测量得到的距离在预先设定好的阈值范围内时，运动控制器发出停车信号，所述AGV停车。
6.如权利要求2所述的基于多窗口实时测距的单目视觉导引AGV的精确定位方法，其特征在于：通过手眼标定实验得到的摄像机内外参数、摄像机的水平视场角和垂直视场角、摄像机的俯仰角、摄像机安装的离地高度参数，将其代入映射关系中。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610286380.9A CN105955259B (zh) | 2016-04-29 | 2016-04-29 | 基于多窗口实时测距的单目视觉agv的精确定位方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610286380.9A CN105955259B (zh) | 2016-04-29 | 2016-04-29 | 基于多窗口实时测距的单目视觉agv的精确定位方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN105955259A CN105955259A (zh) | 2016-09-21 |
| CN105955259B true CN105955259B (zh) | 2019-04-23 |
Family
ID=56914619
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201610286380.9A Active CN105955259B (zh) | 2016-04-29 | 2016-04-29 | 基于多窗口实时测距的单目视觉agv的精确定位方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN105955259B (zh) |
Families Citing this family (24)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106444758B (zh) * | 2016-09-27 | 2019-07-23 | 华南农业大学 | 一种基于机器视觉的道路识别与路径优选的agv运输车 |
| CN106651953B (zh) * | 2016-12-30 | 2019-10-18 | 山东大学 | 一种基于交通指示牌的车辆位姿估计方法 |
| CN107065879A (zh) * | 2017-05-16 | 2017-08-18 | 中国计量大学 | 基于二维码的视觉导引车定位方法及视觉导引车 |
| DE102017212221A1 (de) * | 2017-07-18 | 2019-01-24 | Audi Ag | Fernsteuerungsverfahren für ein Fahrerassistenzsystem, Fahrerassistenzsystem und damit versehenes Kraftfahrzeug |
| CN107516328B (zh) * | 2017-08-23 | 2021-02-12 | 山东非凡智能科技有限公司 | 一种agv工作点定位方法及系统 |
| CN108398946B (zh) * | 2018-01-25 | 2021-12-21 | 成都图灵时代科技有限公司 | 智能循迹精确定位装置与方法 |
| CN108268044B (zh) * | 2018-01-31 | 2021-06-22 | 浙江国自机器人技术股份有限公司 | 一种移动机器人到位精度控制方法、系统、介质及设备 |
| US10802498B2 (en) * | 2018-05-30 | 2020-10-13 | Datalogic Ip Tech S.R.L. | Target direction estimation using centroid follower |
| CN110570687B (zh) * | 2018-06-06 | 2021-04-27 | 杭州海康机器人技术有限公司 | Agv的控制方法、装置及存储介质 |
| CN109032129B (zh) * | 2018-06-21 | 2021-07-27 | 昆山华恒工程技术中心有限公司 | 路径纠偏方法及装置、路径导引方法、可读介质 |
| CN108873904B (zh) * | 2018-07-04 | 2021-01-22 | 北京踏歌智行科技有限公司 | 矿用车辆无人驾驶停靠方法、设备及可读存储介质 |
| CN109131082B (zh) * | 2018-08-31 | 2022-03-15 | 深圳以恒科技有限公司 | 一种完全基于视觉的单目全景泊车影像系统及其泊车方法 |
| CN109386155B (zh) * | 2018-09-20 | 2020-08-14 | 同济大学 | 面向自动化停车场的无人泊车搬运机器人的对位方法 |
| WO2020113528A1 (zh) * | 2018-12-06 | 2020-06-11 | 深圳市大疆创新科技有限公司 | 一种导航处理方法、装置及导航处理设备 |
| CN112241944B (zh) * | 2019-07-16 | 2024-03-29 | 杭州海康机器人股份有限公司 | Agv调度系统、物料位姿矫正方法和物料位姿矫正装置 |
| CN110412982B (zh) * | 2019-07-31 | 2022-07-15 | 长沙理工大学 | 基于单目相机测距不确定的机器人路径稳健性规划方法 |
| CN110765922B (zh) * | 2019-10-18 | 2023-05-02 | 华南理工大学 | 一种agv用双目视觉物体检测障碍物系统 |
| CN110794417B (zh) * | 2019-10-29 | 2023-08-01 | 北京星航机电装备有限公司 | 基于stm32和激光雷达实现汽车姿态测量定位的方法 |
| CN110852279B (zh) * | 2019-11-12 | 2022-05-03 | 深圳创维数字技术有限公司 | 托盘识别和定位方法、设备及计算机可读存储介质 |
| CN110816355B (zh) * | 2019-11-12 | 2021-07-20 | 深圳创维数字技术有限公司 | 车辆充电方法、设备及计算机可读存储介质 |
| CN112083718B (zh) * | 2020-08-13 | 2023-08-04 | 惠州拓邦电气技术有限公司 | 视觉导航机器人的控制方法、装置及计算机可读存储介质 |
| CN113625713B (zh) * | 2021-08-11 | 2024-04-16 | 北京京东振世信息技术有限公司 | 自动引导运输车的控制方法和装置 |
| CN114252013B (zh) * | 2021-12-22 | 2024-03-22 | 深圳市天昕朗科技有限公司 | 一种基于有线通讯模式下的agv视觉识别精准定位系统 |
| CN115761684B (zh) * | 2023-01-10 | 2023-06-16 | 常熟理工学院 | 基于机器视觉的agv目标识别与姿态角解算方法及系统 |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS63225805A (ja) * | 1987-03-14 | 1988-09-20 | Shinko Electric Co Ltd | 無人誘導車の走行制御方法 |
| CN101425705A (zh) * | 2008-11-14 | 2009-05-06 | 南京航空航天大学 | 自动引导小车的无接触供电及导航装置 |
| CN101860729A (zh) * | 2010-04-16 | 2010-10-13 | 天津理工大学 | 一种用于全方位视觉的目标跟踪方法 |
| CN104483966A (zh) * | 2014-11-17 | 2015-04-01 | 范良志 | 一种agv导航控制系统 |
| CN105444741A (zh) * | 2015-12-17 | 2016-03-30 | 南京航空航天大学 | 基于双视野窗口的路径特征识别、偏差测量与精确定位方法 |
-
2016
- 2016-04-29 CN CN201610286380.9A patent/CN105955259B/zh active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS63225805A (ja) * | 1987-03-14 | 1988-09-20 | Shinko Electric Co Ltd | 無人誘導車の走行制御方法 |
| CN101425705A (zh) * | 2008-11-14 | 2009-05-06 | 南京航空航天大学 | 自动引导小车的无接触供电及导航装置 |
| CN101860729A (zh) * | 2010-04-16 | 2010-10-13 | 天津理工大学 | 一种用于全方位视觉的目标跟踪方法 |
| CN104483966A (zh) * | 2014-11-17 | 2015-04-01 | 范良志 | 一种agv导航控制系统 |
| CN105444741A (zh) * | 2015-12-17 | 2016-03-30 | 南京航空航天大学 | 基于双视野窗口的路径特征识别、偏差测量与精确定位方法 |
Non-Patent Citations (1)
| Title |
|---|
| 自动导引车视觉导引路径的识别及精确测量;喻俊 等;《华南理工大学学报（自然科学版）》;20120331;第40卷(第3期);第143-149页 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN105955259A (zh) | 2016-09-21 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN105955259B (zh) | 基于多窗口实时测距的单目视觉agv的精确定位方法 | |
| CN108960183B (zh) | 一种基于多传感器融合的弯道目标识别系统及方法 | |
| CN106228110B (zh) | 一种基于车载双目相机的障碍物及可行驶区域检测方法 | |
| CN105512628B (zh) | 基于无人机的车辆环境感知系统及方法 | |
| CN106651953B (zh) | 一种基于交通指示牌的车辆位姿估计方法 | |
| CN100494900C (zh) | 适用于自主移动车辆的环境感知的单目视觉导航方法 | |
| CN109849922B (zh) | 一种用于智能车辆的基于视觉信息与gis信息融合的方法 | |
| CN109359409A (zh) | 一种基于视觉与激光雷达传感器的车辆可通过性检测系统 | |
| CN106156723B (zh) | 一种基于视觉的路口精定位方法 | |
| CN109085823A (zh) | 一种园区场景下基于视觉的低成本自动循迹行驶方法 | |
| CN109386155A (zh) | 面向自动化停车场的无人泊车搬运机器人的对位方法 | |
| CN106909148A (zh) | 基于农田环境感知的农机无人驾驶导航方法 | |
| KR102146451B1 (ko) | 좌표계 변환 정보 획득 장치 및 방법 | |
| CN108345005A (zh) | 巷道掘进机的实时连续自主定位定向系统及导航定位方法 | |
| MX2015001228A (es) | Dispositivo de deteccion de objetos tridimensionales, y metodo de deteccion de objetos tridimensionales. | |
| CN103196418A (zh) | 一种弯道车距测量方法 | |
| CN103487034A (zh) | 一种基于立式标靶的车载单目摄像头测距测高方法 | |
| CN105699985A (zh) | 一种单线激光雷达装置 | |
| CN103729837A (zh) | 一种单个路况摄像机的快速标定方法 | |
| CN110307791A (zh) | 基于三维车辆边界框的车辆长度及速度计算方法 | |
| CN105444741A (zh) | 基于双视野窗口的路径特征识别、偏差测量与精确定位方法 | |
| CN106407948A (zh) | 基于红外夜视仪的行人检测与识别方法 | |
| CN110415298A (zh) | 一种用于车道偏离的计算方法 | |
| CN108196538B (zh) | 基于三维点云模型的田间农业机器人自主导航系统及方法 | |
| CN114808649B (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 | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |