摘要

针对当前视觉导航重载AGV系统色带引导、扫码定位方式所存在的路径铺设复杂、色带易受环境干扰等问题，设计了基于自抗扰控制(ADRC)的3C视觉导航重载 AGV系统．该设计采用3个独立高速单目相机对AGV结构进行改进，以实现无色带引导，用相机扫描地面站点的数据矩阵码信息，将得到的图像偏差信息传递给控制器，经过ADRC实时调整AGV运行轨迹，实现重载AGV导航定位．仿真与实际应用结果表明，该系统运行稳定且灵活，AGV响应速度快，能有效实现轨迹的实时跟踪且导航精度明显提高，最大导航误差绝对值小于8mm，最大偏移角绝对值小于1°

0 引言

自动导引车 AGV ( automated guided vehicle) 是指以各类电、磁、声、光传感器为自动导引装置，能够按照预设导引路径行驶的无人驾驶运输车［1］． 随着智慧工厂与智能物流的不断发展，重载 AGV 有望成为智慧仓储物流系统的关键角色，实现各生产环节物料的自动运输，保证整个生产线高效运行［2－3］．
AGV的导航定位精度和路径调整能力是制约其在工业领域推广应用的瓶颈［4］．当前的导航方式主要有磁导航［5－6］、惯性导航［7］、激光导航［8］、视觉导航［9］等．
磁导航运用电磁感应原理，其导航元件多种多样，如地标磁钉［5］、电涡流线圈和射频器件［6］等，虽然磁导航在AGV行业中应用广泛，但其铺设成本较高，不便于后期维护与调整，难以满足现代化柔性生产过程中的重载转运需求;惯性导航技术定位准确性高，灵活性强，但对控制算法的要求较高且容易受周围环境的影响;激光导航需在AGV行驶路径的周围安装激光反射板，对安装角度和位置都有非常精确的要求，成本较高，且易受环境干扰，不适合环境复杂的工厂环境;视觉导航利用图像处理技术进行导航，应用于工业重载AGV经济成本低、实用性强，但传统的视觉导航方式大多采用色带引导、扫码定位方式，在实际应用中存在路径铺设复杂、色带易受环境干扰等问题．在实际运行过程中，AGV的运行轨迹容易因非线性因素和系统内、外部扰动影响而出现偏差．
为了提高AGV系统控制精度，文献［10］将PID与模糊控制相结合，采用模糊规则对PID控制参数进行在线调整，虽然系统具有一定的鲁棒性，但对复杂多变的应用环境适应性较差．文献［11］提出的自适应反演滑模控制方法使系统响应更快，鲁棒性更强，且具有良好的瞬时性能，但用于重载AGV易出现抖振现象，直接影响控制效果．自抗扰控制 ADRC(active disturbance rejection control)技术在PID控制基础上，将非线性因素和系统内、外部扰动视为总扰动，通过构造扩张状态观测器对总扰动进行实时估计与补偿，消除各种不确定因素的影响［12］，具有控制参数少、收敛速度快、误差补偿效果好等优点．

基于此，本文拟采用3个独立高速单目相机，对基于色带引导和扫码定位的传统视觉导航方式重载AGV结构进行改进，在AGV控制系统中采用ADRC控制策略对扰动进行实时补偿，以期提高AGV的运动灵活性和导航精度．

1 系统设计

AGV运行时的导航灵活性和精度是评价其系统性能的关键因素． 导航的灵活性与导航方式和AGV结构有关，导航精度与AGV控制算法有直接联系．

本文对采用传统视觉导航方式的重载AGV结构进行改进，将色带引导和扫码定位导航中的1个或2个单目高速相机改为3个独立单目高速相机(3C)，且对其铺设方式进行优化，改进后的AGV无需色带引导，只需扫码就可以实现导航，AGV运行灵活．在AGV控制算法上，采用ADRC策略对扰动进行实时补偿，以消除各种不确定因素的影响，使AGV运行稳定、快速响应，能适用于复杂车间环境．经过改进的3C视觉导航重载AGV结构如图1所示，其中AGV中心轴①—③位置安装高速单目视觉相机，且相机1与相机2之间的中心距离和相机2与相机3之间的中心距离相等． 相机采用PGV光学相机，通过双舵轮驱动设计，可实现原地360°转弯; 为避免冲突，在④—⑦位置上安装激光避障雷达．
AGV控制系统结构如图2所示，主要由电池管理模块、避障模块、3C 视觉导航模块、伺服驱动与转向模块、车载控制模块和上位机控制模块等组成． 控制系统采用分布式控制，由两级微机组成，车载控制模块采用西门子S7－1200PLC，上位机控制模块采用工控机，既可以实现单AGV独立运行，又可以实现多AGV同时运行．

图 1 改进后的3C视觉导航重载AGV结构

图 2 AGV 控制系统结构图

1.1 3C视觉导航设计

根据改进后AGV上3个相机分布的结构特点，设计数据矩阵码的铺设方式，相邻两个数据矩阵码之间的中心距离与两个相机之间中心距离相等．AGV导航示意图见图 3，其中编号5—8是铺设在地面上的数据矩阵码．当AGV从站点5运动到站点6时，AGV运行分为两步:1)相机1与相机3同时分别扫描站点6与站点5的信息，AGV减速运行; 2) 当相机2中心位置与站点6中心位置坐标重合时，AGV停止．
在行进过程中，AGV难免会出现轨迹误差，因此为保证AGV轨迹出现误差后能及时进行修正，3个独立相机在站点间运行时(即从矩阵码进入扫描区到离开扫描区)，不断扫描站点误差，并将扫描误差信息实时传递给上位机．上位机控制算法对其轨迹进行修正并下发给AGV进行轨迹跟踪，从而实现AGV导航．视觉相机在AGV中轴线上，AGV偏移量由数据矩阵码偏差值和偏移角度组成．在AGV运行过程中，相机在某时刻扫描某数据矩阵码时偏差和偏移角度如图4所示．图4以相机读取区域建立局部坐标系，以工作车间建立全局坐标;由1，2，3，4组成的正方形区域是数据矩阵码，偏差角是α0.在AGV运行过程中，只要有一个相机扫描到数据矩阵码，前、后舵轮就会同时自动地进行误差修正，这种修正方式较灵活，运算量较小．

图 3 AGV导航示意图

图 4 扫描数据矩阵码偏差和偏移角度示意图

全局坐标下相机读取区域中心位姿为O(x0'，y0'，α0')，将其转化为AGV偏差位姿O(x0，y0，α0).数据矩阵码中心位姿为O'(xr'，yr'，αr')，将其转化为AGV期望位姿O'(xr，yr，αr)．AGV期望轨迹运动学模型为

其中，vr为期望速度，ωr为期望角速度，αr值可为0°，±90°，180°．将全局变量下位姿误差转换到局部变量下AGV位姿误差公式［13］为

局部坐标下AGV位姿误差微分方程为

其中，v0为AGV运行速度，ω0为AGV运行角速度．

1.2 ADRC跟踪器设计

在AGV系统中，ADRC是用于上位机控制模块的控制算法．通过3C视觉导航采集的坐标信息传递给上位机，经过上位机中的ADRC跟踪器进行修正，将修正后的坐标指令下发给PLC，再通过PLC对AGV进行控制．

1.2.1 ADRC数学模型

ADRC跟踪器主要包含微分跟踪器、扩张状态观察器和误差反馈系统．微分跟踪器( TD) 线性状态方程为

其中，r0 为跟踪速度因子，r0 越大跟踪速度越快; f0为输入信号; f1，f2为 f0的跟踪信号．
扩张状态观察器( ESO) 线性误差方程为

其中，u为被控系统输入;y为ADRC输出;z1，z2，z3为系统状态变量估计值;β01，β02和β03为设置参数;b为控制量系数．误差反馈控制系统中目标与输出值之间的误差及其微分误差信号和被控系统输入，相应计算公式分别为