摘要

针对当前视觉导航重载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停止．