0 引言

基于双轮差速驱动的仓储物流搬运AGV结构简单，控制便当，广泛应用于种种物流分拣系统中。由于AGV搭载的传感器读数误差和机械传动误差具有累计效应，其误差会随着时间的增加而增大。如果不可检测并消除移动历程中爆发的位置累计误差和航向角累计误差，将导致导航过失。迄今为止，已经有许多在工业生产中被使用或在实验室里被设计并证明可用的累计误差检测要领。张涛[1]等人设计了一种基于单目视觉的二维码导航误差检测要领，将定位误差控制在±4 cm以内；Arturo Gil等人[2]通过提取视觉地标，获得它们的相对丈量值，通过估算机械人的路径和视觉地标的位置来消除运动历程中的累积误差；张艳[3]等人使用DM二维码导航方法检测爆发的累积误差，实现了AGV自主导航与精准定位；罗高[4]等人使用里程计结合单目视觉测距对移动机械人误差检测和定位技术进行研究；王勇[5]等人通过自适应位姿跟踪，提高了AGV在高遮挡情况下的定位精度。

目前对运动历程中爆发的累积误差进行检测的要领保存位置误差检测以及航向角误差检测精度低、抗滋扰能力弱等缺点。为此，本文基于单目视觉[6]和信标[7,8]，设计了一种应用于室内仓储物流搬运AGV的运动累计误差检测要领。本要领在运动节点处设置特定信标，首先对信标图像进行灰度处理，盘算信标图像的内间方差，使用最大内间方差对应的支解阈值对灰度图像进行支解，获取二值图像；其次在二值图像的基础上使用栅格对图像进行支解，对含有前景色的栅格单位进行聚类，使用平均值算法求解信标的中心点坐标，并凭据位置关系将中心点与信标定位块一一对应；然后建立误差盘算模型，盘算运动历程中爆发的累积误差；最后通过实验验证所述要领能够检测出仓储物流搬运AGV运动历程中爆发的累积误差，该要领具有较高的精度，满足仓储物流搬运AGV精准定位的要求。

1 累积误差检测计划

双轮差速驱动搬运AGV在运动历程中，由于传感器的累积误差、机械传动误差以及装配误差等因素，会导致AGV通过传感器读数盘算的位姿与实际位姿之间爆发累积误差。具体体现在短时间内AGV定位精度下降，随着时间的增加，累积误差会越来越大，最后导致AGV运动蜕化。为了包管AGV运动的正确性，须在累积误差造成运动过失前，检测出累积误差并对误差进行赔偿。

接纳无畸变摄像头，其成像原理[9,10]如图1所示，图像传感器所在平面与信标所在平面平行。信标中含有3个定位块，划分为A、B、C，其中A的中心点为校准点，OC为摄像头光心，ZC为摄像机主轴，O-XYZ为世界坐标系，OC-XCYC ZC为摄像机坐标系，o1-x1 y1为图像坐标系，o-xy为信标中各定位块中心点确定的信标坐标系，o′-x′y′为信标坐标系在图像平面的投影。依据定位块A、B、C在图像传感器上成像中心点坐标之间的相对位置确定坐标系o′-x′y′。通过建立坐标系o′-x′y′与坐标系o1-x1 y1之间的旋转、平移关系模型，可以盘算出航向角累积误差θ，在摄像头装置高度h和摄像头焦距f已知的条件下，可以求出图像传感器中心点在信标坐标系下关于x轴、y轴的位置累积误差dx、dy。

图1 世界坐标系与图像坐标系之间的关系模型  

2 盘算定位块中心点在图像传感器上坐标

2.1 基于栅格支解的聚类要领

首先凭据灰度处理[11]、求解最大内间方差[12]、动态阈值支解[13]、中值滤波[14]流程获取二值图像，然后划分提取出前景色中的3个定位块，并盘算每个定位块的中心点坐标，确定坐标系o′-x′y′。信标的支解聚类要领是接纳栅格将二值图像支解成若干个单位，再对栅格单位进行聚类，过去景色中将3个定位块疏散。

使用聚类法从支解后的图像中筛选出含有前景色的单位，凭据以下要领疏散定位块：

Step1设所有含有前景色像素点的单位组成荟萃S,S={s1,s2,s3，……，sn}，通过遍历法可确定荟萃S中所有的元素；

Step 2建立空集A1，将荟萃S中的第1个元素s1添加到荟萃A1中并将s1从荟萃S中移除；

Step 3从荟萃S第1个元素开始，依次取荟萃S中的元素si与荟萃A1中的所有元素进行比较，若这两个元素代表的单位相邻，则将荟萃S中的元素si添加到荟萃A1中并将元素si从荟萃S中移除；

Step 4重复办法Step 3，直至荟萃A1中的任意元素aj与荟萃S中任意元素si划分所代表的单位不相邻；

Step 5判断荟萃S是否为空集，若为空集则前景色分聚类完成，不然重复Step 2至Step 5，划分建立荟萃A2、A3、A4、……、An，直至荟萃S为空集，并且将A1、A2、A3、……、An作为元素组成荟萃A，即A={A1,A2,A3……An}。

支解聚类实验结果如图2所示。

图2 支解聚类结果   

2.2 各定位块中心点坐标盘算

关于至少具有两条相互笔直的对称轴图形，可使用平均值算法盘算图形中心点。图形中心点坐标满足

式中：为第t个定位块的中心点在图像坐标系o1-x1 y1下的横坐标,yt为第t个定位块的中心点在图像坐标系o1-x1 y1下的纵坐标，n为第t个定位块中玄色像素点的总个数，xi为第t个定位块中第i个玄色像素点在图像坐标系o1-x1 y1下的横坐标，yi为第t个定位块中第i个玄色像素点在图像坐标系o1-x1 y1下的纵坐标。

利用式(1)可以盘算出荟萃A中每个元素对应的中心点坐标oi，所有中心点组成荟萃O，即O={o1,o2,o3，……，on}。关于所述要领，O={o1,o2,o3}。

任意两定位块中心点之间的距离

式中：h为摄像头的装置高度，f为摄像头的焦距，xi为中心点io在图像坐标系o1-x1 y1下的横坐标，yi为中心点io在图像坐标系o1-x1 y1下的纵坐标，xj为中心点oj在图像坐标系o1-x1 y1下的横坐标，yj为中心点oj在图像坐标系o1-x1 y1下的纵坐标。

i、j k划分取1、2、3且互不相同。当dk取得最大值时中心点及对应边长如图3所示。

图3 中心点及对应边长   

中心点ok对应定位块A，记中心点ok的坐标为（xk,yk），取中心点oi(xi,yi），构建向量，利用式(3)判断中心点oj(xj,yj）与向量之间的关系，有

当t>0，点oj在oi的左侧，中心点oi对应定位块B，中心点oj对应定位块C；当t<0，点oj在oi的右侧，中心点oi对应定位块C，中心点oj对应定位块B。确定定位块中心点在图像坐标系o1-x1 y1下的坐标，将定位块A、B、C的中心点在图像传感器上的投影记为A(x a,y a),B(x b,y b),C(x c,y c)。

3 累积误差盘算模型

图像坐标系o1-x1 y1与信标投影坐标系o′-x′y′之间的旋转、平移关系模型如图4所示。

图中，dx为AGV在信标坐标系下X轴偏向上位置累积误差，dy为AGV在信标坐标系下Y轴偏向上位置累积误差，θx为AGV在信标坐标系下X轴偏向上航向角累积误差，θy为AGV在信标坐标系下Y轴偏向上航向角累积误差，有

图4 累计误差盘算模型   

最终角度偏差取θx、θy的平均值，即

表1 实验结果和实际丈量结果  

4 实验结果

实验接纳无畸变摄像头，将其装置于AGV的回转中心并与地面坚持平行，拍摄位于地面的特定信标。利用所述要领盘算在任意位置下的位置偏差和角度偏差，将实际丈量值与盘算结果进行比较。每次实验进行20次盘算，进行6次独立重复实验。选取第1次、第10次、第20次的实验结果和实际丈量结果，如表1所示。

第1次独立重复实验的盘算结果与实际丈量结果进行比较，误差如图5所示。

图5 盘算结果与丈量结果之间的误差   

由表1可知，每次独立重复实验盘算结果，dx、dy的波动不凌驾1 mm，θ的波动不凌驾0.5°，说明本要领盘算结果具有较高的稳定性。从图5可以看出，每次独立重复实验盘算结果与实际丈量结果相比较，dx、dy的误差不凌驾1 mm，θ的误差不凌驾1°，说明本要领具有较高的准确度。6次独立重复实验的盘算结果与实际丈量结果相比较，结果都在误差允许规模内，说明本要领具有较高的可靠性。

5 结语

从信标特征识别开始到定位偏差盘算，研究了一种用于仓储物流搬运AGV运动累积误差检测要领。针对特定的信标，在特征提取中使用栅格对二值图像进行支解，对栅格单位进行聚类，利用平均值算法盘算信标中定位块的中心点坐标，建立图像与世界坐标系的旋转、平移关系模型，盘算仓储物流搬运AGV在世界坐标系下的位姿。最后通过实验丈量，将盘算结果与丈量结果比较，证明所述要领具有较高精度、稳定性和可靠性。进一步提高图像处理速度和提高定位精度是下一步研究重点。