一种基于光流估计获取AGV位置的方法技术

本发明专利技术公开了一种基于光流估计获取AGV位置的方法，包括以下步骤：在AGV经过二维码时，获取二维码的位置信息，并利用AGV上的图像采集装置对AGV在运动过程中的图像进行实时采集；获取图像采集装置实时采集的图像，从中筛选出连续两帧图像，并根据连续两帧图像建立图像约束方程；对图像约束方程进行展开得到展开方程；联合图像约束方程和展开方程得到速度方程；建立一窗口，根据速度方程建立对应窗口的速度方程组；对速度方程组进行最小化，得到速度矢量；根据二维码的位置信息和速度矢量，得到AGV在经过的二维码与下一二维码之间的位置。本发明专利技术用于解决采用现有的相对定位方法对AGV进行定位时，定位不准确的技术问题。定位不准确的技术问题。定位不准确的技术问题。

【技术实现步骤摘要】
一种基于光流估计获取AGV位置的方法


[0001]本专利技术涉及图像处理
，具体涉及一种基于光流估计获取AGV位置的方法。

技术介绍

[0002]自动导航车AGV是一种自动化无人驾驶的智能化搬运设备，是现代工业自动化物流系统中的关键设备。AGV的定位系统是实现自动导引的关键部分，也是目前的研究热点，定位是指AGV通过感知自身和周围环境信息，经过一定的数据处理得到自身位姿的过程。目前AGV定位主要分为两类：绝对定位和相对定位。
[0003]常用的绝对定位方式有全球定位系统(GPS)、超声波定位系统、红外网络系统、射频识别系统等等。其中，GPS不能用在室内，并且更新频率较低；超声波定位系统和红外网络系统具有低成本、小型化和易于连接的特点，然而这两种方法不能在长距离下使用，同时需要在场景中大面积布置，并且由于存在信号干扰而难以满足AGV的定位要求；而射频识别系统需要额外的设备和较高的成本。这些绝对定位方法的优点在于它们不会积累定位误差，但整体定位误差较大。
[0004]相对定位主要为里程计算法，通过在AGV工作的场所地面上贴二维码，然后在AGV上安装一个二维码相机来定位地上的二维码从而确定AGV的位置，当AGV在二维码和二维码之间时，通过轮式里程计基于上一次二维码相机定位到的二维码位置来推算AGV的位置。
[0005]通过轮式里程计推算AGV在二维码和二维码之间的位置，需要精确的二维码相机和轮子之间的机械相对位姿关系，但是实际设备生产中总会出现安装误差导致二维码相机和轮子之间的位姿有误差，使得轮式里程计基于上一次二维码相机定位到的二维码位姿推算出来的AGV位姿不准确，导致AGV在二维码和二维码之间的定位不准确。

技术实现思路

[0006]为了克服现有技术的不足，本专利技术提供一种基于光流估计获取AGV位置的方法，用于解决采用现有的相对定位方法对AGV进行定位时，定位不准确的技术问题，从而达到提高AGV定位精度的目的。
[0007]为解决上述问题，本专利技术所采用的技术方案如下：
[0008]一种基于光流估计获取AGV位置的方法，其特征在于，包括以下步骤：
[0009]在AGV经过二维码时，获取所述二维码的位置信息，并利用所述AGV上的图像采集装置对所述AGV在运动过程中的图像进行实时采集；
[0010]获取所述图像采集装置实时采集的图像，从中筛选出连续两帧图像，并根据所述连续两帧图像建立图像约束方程；
[0011]对所述图像约束方程进行展开得到展开方程；
[0012]联合所述图像约束方程和所述展开方程得到速度方程；
[0013]建立一窗口，根据所述速度方程建立对应所述窗口的速度方程组；
[0014]对所述速度方程组进行最小化，得到速度矢量；
[0015]根据所述二维码的位置信息和所述速度矢量，得到所述AGV在经过的二维码与下一二维码之间的位置。
[0016]作为本专利技术优选的实施方式，在建立图像约束方程时，包括：
[0017]获取所述连续两帧图像上的特征点，利用近似最近邻搜索方法对所述特征点进行预匹配，再利用双向交叉匹配法提高匹配的精度，得到最终特征匹配点对。
[0018]作为本专利技术优选的实施方式，在利用近似最近邻搜索方法对所述特征点进行预匹配时，包括：
[0019]将所述连续两帧图像分别转换成第一灰度图和第二灰度图，并分别提取所述第一灰度图和所述第二灰度图的SURF特征点；
[0020]利用所述近似最近邻搜索方法，获取所述第一灰度图任意特征点在所述第二灰度图上的距离最近的对应特征点，得到侯选特征匹配点对。
[0021]作为本专利技术优选的实施方式，在利用双向交叉匹配法提高匹配的精度时，包括：
[0022]执行候选匹配对获取步骤，包括：
[0023]遍历所述第一灰度图中的候选匹配特征点，针对所述第一灰度图中的候选匹配特征点A1，遍历所述第二灰度图中的各个候选匹配特征点，获取所述候选匹配特征点A1在所述第二灰度图中匹配的第一候选匹配特征点B1和第二候选匹配特征点B2；
[0024]所述第一候选匹配特征点B1、所述第二候选匹配特征点B2与所述候选匹配特征点A1之间的关系满足如下公式1：
[0025][0026]式中，D(A1,B1)是候选匹配特征点A1与第一候选匹配特征点B1的距离相似性度量值，D(A1,B2)是候选匹配特征点A1与第二候选匹配特征点B2的距离相似性度量值，Y
h
为设定的阈值；
[0027]取所述候选匹配特征点A1和所述第一候选匹配特征点B1构成候选匹配对；
[0028]其中，所述第一候选匹配特征点为最近邻候选匹配特征点，所述第二候选匹配特征点B2为次近邻候选匹配特征点。
[0029]作为本专利技术优选的实施方式，在利用双向交叉匹配法提高匹配的精度时，还包括：
[0030]以所述第一灰度图中的候选匹配特征点作为遍历对象，按照所述候选匹配对获取步骤遍历所述第一灰度图中的每个候选匹配特征点，得到所述第一灰度图的所有候选匹配对，并根据所述第一灰度图的所有候选匹配对组成第一候选匹配对集合；
[0031]以所述第二灰度图中的候选匹配特征点作为遍历对象，按照所述候选匹配对获取步骤遍历所述第二灰度图中的每个候选匹配特征点，得到所述第二灰度图的所有候选匹配对，并根据所述第二灰度图的所有候选匹配对组成第二候选匹配对集合；
[0032]将所述第一候选匹配对集合和所述第二候选匹配对集合进行比较，筛选出其中完全相同的候选匹配对，作为最终的特征点匹配对集合；
[0033]其中，所述最终的特征点匹配对集合包含多个最终特征匹配点对。
[0034]作为本专利技术优选的实施方式，在建立图像约束方程时，还包括：
[0035]分别获取所述连续两帧图像的采集时间；
[0036]获取所述第一灰度图和所述第二灰度图中的最终特征匹配点对，根据所述最终特
征匹配点对和所述采集时间建立所述图像约束方程，具体如公式2所示：
[0037]I(x,y,t)＝I(x+δx,y+δy,t+δt)(2)；
[0038]式中，x代表第一灰度图最终特征匹配点的X轴坐标，y代表第一灰度图最终特征匹配点的Y轴坐标，x+δx代表第二灰度图最终特征匹配点的X轴坐标，y+δy代表第二灰度图最终特征匹配点的Y轴坐标，δx代表X轴相对位移，δy代表Y轴相对位移，t代表第一帧图像的采集时间，t+δt代表第二帧图像的采集时间，δt代表两帧时间差，I(x,y,t)代表t时刻第一灰度图最终特征匹配点的亮度，I(x+δx,y+δy,t+δt)代表t+δt时刻第二灰度图最终特征匹配点的亮度。
[0039]作为本专利技术优选的实施方式，在对所述图像约束方程进行展开得到展开方程时，包括：
[0040]根据所述第一灰度图最终特征匹配点的坐标(x,y)和所述第一帧图像的采集时间t，并利用泰勒公式对t+δt时刻第二灰度图最终特征匹配点的亮度函本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于光流估计获取AGV位置的方法，其特征在于，包括以下步骤：在AGV经过二维码时，获取所述二维码的位置信息，并利用所述AGV上的图像采集装置对所述AGV在运动过程中的图像进行实时采集；获取所述图像采集装置实时采集的图像，从中筛选出连续两帧图像，并根据所述连续两帧图像建立图像约束方程；对所述图像约束方程进行展开得到展开方程；联合所述图像约束方程和所述展开方程得到速度方程；建立一窗口，根据所述速度方程建立对应所述窗口的速度方程组；对所述速度方程组进行最小化，得到速度矢量；根据所述二维码的位置信息和所述速度矢量，得到所述AGV在经过的二维码与下一二维码之间的位置。2.根据权利要求1所述的基于光流估计获取AGV位置的方法，其特征在于，在建立图像约束方程时，包括：获取所述连续两帧图像上的特征点，利用近似最近邻搜索方法对所述特征点进行预匹配，再利用双向交叉匹配法提高匹配的精度，得到最终特征匹配点对。3.根据权利要求2所述的基于光流估计获取AGV位置的方法，其特征在于，在利用近似最近邻搜索方法对所述特征点进行预匹配时，包括：将所述连续两帧图像分别转换成第一灰度图和第二灰度图，并分别提取所述第一灰度图和所述第二灰度图的SURF特征点；利用所述近似最近邻搜索方法，获取所述第一灰度图任意特征点在所述第二灰度图上的距离最近的对应特征点，得到侯选特征匹配点对。4.根据权利要求3所述的基于光流估计获取AGV位置的方法，其特征在于，在利用双向交叉匹配法提高匹配的精度时，包括：执行候选匹配对获取步骤，包括：遍历所述第一灰度图中的候选匹配特征点，针对所述第一灰度图中的候选匹配特征点A1，遍历所述第二灰度图中的各个候选匹配特征点，获取所述候选匹配特征点A1在所述第二灰度图中匹配的第一候选匹配特征点B1和第二候选匹配特征点B2；所述第一候选匹配特征点B1、所述第二候选匹配特征点B2与所述候选匹配特征点A1之间的关系满足如下公式1：式中，D(A1,B1)是候选匹配特征点A1与第一候选匹配特征点B1的距离相似性度量值，D(A1,B2)是候选匹配特征点A1与第二候选匹配特征点B2的距离相似性度量值，Y
h
为设定的阈值；取所述候选匹配特征点A1和所述第一候选匹配特征点B1构成候选匹配对；其中，所述第一候选匹配特征点为最近邻候选匹配特征点，所述第二候选匹配特征点B2为次近邻候选匹配特征点。5.根据权利要求4所述的基于光流估计获取AGV位置的方法，其特征在于，在利用双向
交叉匹配法提高匹配的精度时，还包括：以所述第一灰度图中的候选匹配特征点作为遍历对象，按照所述候选匹配对获取步骤遍历所述第一灰度图中的每个候选匹配特征点，得到所述第一灰度图的所有候选匹配对，并根据所述第一灰度图的所有候选匹配对组成第一候选匹配对集合；以所述第二灰度图中的候选匹配特征点作为遍历对象，按照所述候选匹配对获取步骤遍历所述第二灰度图中的每个候选匹配特征点，得到所述第二灰度图的所有候选匹配对，并根据所述第二灰度图的所有候选匹配对组成第二候选匹配对集合；将所述第一候选匹配对集合和所述第二候选匹配对集合进行比较，筛选出其中完全相同的候选匹配对，作为最终的特征点匹配对集合；其中，所述最终的特征点匹配对集合包含多个最终特征匹配点对。6.根据权利要求5所述的基于光流估计获取AGV位置的方法，其特征在于，在建立图像约束方程时，还包括...

【专利技术属性】
技术研发人员：邹家帅，昝学彦，李发频，李飞军，张四龙，李家钧，蒋干胜，徐波，
申请(专利权)人：珠海创智科技有限公司，
类型：发明
国别省市：