近年来，随着机器人技术的快速发展，机器人的应用已经越来越广泛。自动导引车AGV作为一种轮式移动机器人，具有可靠性高、适应能力强、自动化程度高等优点，在现代制造系统和仓储物流系统中被广泛用于货物的运送与传输，是现代仓储系统及柔性制造系统的关键设备之一“。导引与轨迹跟踪是实现AGV自主移动的关键技术，铺设预定轨迹的方法具有使用方便、成本低的特点，目前被广泛应用于工程实际。由于AGV车轮与地面之间属于非完整约束，难以建立较为精确地运动学模型，很多经典成熟的控制算法（如PID控制算法）较难实现而模糊控制是一种基于实践经验通过语言描述的方式来进行分类的算法，无需建立精确的数学模型，容错能力强，应用于非线性系统、高耦合系统等控制系统时有着很好的效果。根据叉车式AGV的结构特点设计了相应的模糊控制器，较好地解决了叉车式AGV在不同路径下的磁导航问题。

1.叉车式AGV结构与运动分析

1.1结构及驱动部分

叉车式AGV的底盘结构主要有五轮式和三轮式。三轮式叉车AGV既不能自转也不能平移，灵活性和稳定性都较差阎。五轮式叉车AGV相较于三轮式，在舵轮左右两侧各增加一个万向轮，既提升了支撑平衡的性能，也能辅助转向，综合性能优于二轮式。在此所研究开发的五轮叉车式AGV的相关尺寸如图1所示。

图1 AGV的底盘结构及尺寸

1.2叉车式AGV的运动和纠偏分析

考虑到叉车式AGV运行时的安全性，通常需保证货叉在人的前方，而AGV的驱动轮位于整车的后部，造成了其运动方式与别的车辆有些不同。以驱动轮和自由轮为代表，对其运动特性进行分析，如图2所示。首先假定AGV与地面间无滑动摩擦，且地面为水平面。当AGV发生转动时，例如，需要AGV往上方偏移一定位移的航线上行驶时。此时，驱动轮率先顺时针转动，再驱动AGV往前行驶，将自由轮驱动到预定的航线上去，然后驱动轮再反向转动，将自身调整到航线上去。该过程通过驱动轮的摆动效果将AGV的运动轨迹调整到理想的航线上。调整过程中沿理想航线上行驶的距离称为调整距离砾调整距离与AGV自由轮的转速、驱动轮转动速度以及2条航线的偏距有关。

1，2，3分别为叉车在纠差过程中出现的初始位置、中间过程、最终位置
图2叉车式AGV底盘运动

2.AGV的导航与控制系统

2.1AGV的导航方式

AGV的导航方式有多种，目前国内常见的有4种,①激光导引利用激光测距以及角度来确定自身定位，并实现按照期望的轨迹运动；②视觉导引通过不断地获取周围的场景信息来定位，在运动过程中边定位边建立场景地图，最终建立整个环境的模型，从而实现自主导航；③惯性导航根据已知位置信息，通过对运动过程中速度和方位的积分来获取自身定位，从而可达到导航的目的；④磁导航通过在预设路径上铺设磁条的方法，装在AGV上的磁传感器获取磁条信息，并通过实时纠偏，从而保证AGV按照预设的轨道行进。以上方式中，磁导航以使用方便、成本低等优点广泛应用于工程实际，故在此基于磁导航展开研究。

2.2控制系统硬件组成

控制系统主要由三大部分构成，即感知部分、决策部分和执行部分,如图3所示。

图3 控制系统组成

1）感知部分作为信息的采集与输人，将底座与磁条的偏差信息传人承担决策作用的STM32开发板。主要有红外传感器、超声波传感器，经传感器信息融合后，可识别叉车周围的环境。
2）决策部分是以STM32F103ZET6嵌人式芯片为控制系统的核心芯片。该芯片是基于Cortex-M3的内核，可以有效地处理感知部分传来的信息，并将分析计算后的结果传送到执行部分，如图4所示。

图4 ARM主控板

3）执行部分主要由转向轮电机与直行轮电机以及货叉结构的液压马达组成，以实现叉车的移动和货物的运送。

2.3 控制系统软件结构

该AGV有2种导航控制方式，基于预设磁条的自主导引控制和手动操作控制。软件控制系统的架构如图5所示。其中，手动控制比较简单，通过电控驱动AGV前进后退，用于AGV的调试和人工驾驶。

图5 AGV软件系统结构

自动控制模式下，一方面需要实时获取AGV相对预设磁条的偏移量，并通过纠偏程序及时地减小偏差，另一方面基于安全考虑，当有意外发生或者磁条上有障碍物存在时，AGV应能够自动紧急制动，并在障碍物移除后可以恢复运行状态。此外，在实际工程中，直线行驶是AGV移动的主要运动状态，考虑到工程效率问题，还需要编写加减速程序。因此，在自动控制模式下主要需要编写自动纠偏程序、紧急制动程序、加减速程序、转弯程序以及货叉升降程序。

3. 模糊控制算法设计

模糊控制是一种模拟人思维的过程，即通过对事物进行观察、分析，最终做出判断与决策。L.A.Zadeh提出不相容原理，随着系统的复杂度增大，系统的清晰程度就会逐渐降低，当达到一定的阈值时，清晰性和复杂性将互相排斥，于是就产生了模糊控制凹。模糊控制是一种非线性控制，核心是利用模糊集合的理论知识，将控制算法转变为计算机语言所能描述的语言。由于模糊控制具有较强的鲁棒性，不需要建立精确的数学模型，尤其是在处理非线性、强耦合时变等控制系统时有较好的效果。
模糊控制器的工作原理是将输人的清晰信号经过模糊化接口变成模糊量，然后经过模糊推理算法计算，经过模糊推理机处理后得到模糊集合，最后由去模糊化将模糊集合变成清晰量。最基本的模糊控制系统结构如图6所示。

图6 模糊控制器的结构

纠偏程序是自动控制模式中的核心，纠偏程序越合理,AGV的轨迹追踪性能就越好。当AGV运行在直线及转弯角度不是很大的弧线上时，将调用纠偏程序。
该AGV所采用的磁导航传感器具有16个磁信号监测点，安装于AGV前端，距离地面2处，选择的磁条宽度为3。在磁条竖直方向上，磁传感器可以同时接通4个磁信号，为确定AGV相对磁条的位置，将磁传感器各个监测点进行编号，H0—H15巧分别为16个监测点，以低电势0表示未检测到磁信号，以高电势1表示检测到磁信号。当检测到磁信号时，指示灯亮起，所有的电势信息依次存储在寄存器中，共占据16字节。纠偏程序中需要针对偏移情况采取继续直行、左偏、右偏的纠偏动作。当正中间的4个监测点对应的指示灯亮起时，此时对应电位为1，表示AGV处于直行状态，见表1。

表 1 磁传感器对应控制器 I/O 端口

考虑到地面不完全平整，应当允许一定的误差范围，当正中间4个监测点左右两侧的另一个指示灯亮起时，也视为直行状态。根据上述分析，可将传感器电位情况模糊化为3种偏差状态，见表2。

表2 三种偏差状态

为使AGV的运行轨迹与预设轨迹更加接近，在编写程序时，根据不同的偏移程度使转向电机的输出力矩有所不同，且纠偏程序中的转向应与表2相反。

4. 路径规划与轨迹跟踪试验

4.1 试验装置及路径规划

选取实验室改造的AGV作为轨迹跟踪的试验对象，如图7所示。

图 7 叉车式 AGV 试验装置

图中，磁传感器位于AGV驱动轮中轴线上，与地面间的距离为2cm，设置了直行、转弯、叉货、卸货等位置的引导路径，所设路径可以满足一般货场的使用要求。根据实际工程需要，预铺设磁导引线，货叉轨迹路径规划如图8所示。空载的AGV从停靠点A出发，沿磁条移动到位置C，然后AGV由位置C运动到位置D处，然后直行至E出仓库，将货叉叉人货物底部取料，托起货物后回退到位置F，然后沿磁条运行至位置F'，然后沿原路线返回至位置A。

图 8 货叉轨迹路径规划

4.2 轨迹跟踪试验

AGV的轨迹跟踪是指让AGV沿着预铺设好的磁条移动。其主要通过实时地调节速度矢量，使AGV保持在磁条上方移动。根据磁传感器感应到的磁信号，可得到位移的偏移量一一左偏1~4位，右偏1~4位，根据偏移量的不同使转向电机输出不同的转向力矩和驱动力矩。AGV性能测试借鉴姚建余对移载式实验型AGV的研究方法,在磁引导线上面贴上20CM×3CM的白色标志条（如图9所示），另外将水性画笔固定在磁传感器的中心位置处，并使画笔笔芯刚好与标志条相接触，记录AGV的实际运动轨迹。

图 9 AGV 模糊控制自动导引系统测试

在进行一次叉货，送货和卸货后，对各标志条上的笔记进行测量，分别记录各标志条笔迹的横向偏移距离，经MatLab分析后得到的结果如图10所示。

图 10 AGV 监测点横向误差

由图可见，AGV在刚启动时偏差范围很小，最大偏差为2cm；在走直线路段时，偏差依旧很小；当走转弯路段时，AGV的偏差便增大，且增大到一定范围后开始减小，继而又增大。因此，叉车式AGV在走转弯路段时的行走路线是曲折的。由试验结果可见，AGV的偏差范围为±6cm，可以满足设计的偏差要求范围。

5 结语

针对叉车式AGV的运动和磁导引特点，设计了一款模糊控制器。对磁传感器检测获取的数字量偏差信号进行分析处理，按照模糊控制规则将结果输出给驱动电机；分析了实际工程中的各种路况工作轨迹，通过编写程序实现AGV的自主导航，提高AGV的纠偏能力。试验结果表明，基于模糊控制的叉车式AGV具有较好的轨迹跟踪性能。

参考文献：

[1] 杨天旭，楼佩煌，钱晓明.融合多模糊控制器的全方位移动 AGV路径跟踪控制技术[J].机械设计与制造工程，2016，45（7）：57-61.
[2] 任彧，赵师涛.磁导航 AGV 深度强化学习路径跟踪控制方法[J].杭州电子科技大学学报：自然科学版，2019，39（2）：28-34.
[3] Chen D D，Shi Z Y，Yuan P J，et al. Trajectory tracking controlmethod and experiment of AGV[C]//2016 IEEE 14th InternationalWorkshop on Advanced Motion Control （AMC）.IEEE，2016：24-29.
[4] 葛红豆，赫雷，曹雏清，等.基于模糊 PID 控制的 AGV 控制[J].兵工自动化，2017，36（12）：76-79.
[5] 孔繁望. 基于不同型式 AGV 的建模及轨迹跟踪控制方法的设计和应用[D].杭州：浙江大学，2018.
[6] 王殿君，关似玉，陈亚，等.双驱双向 AGV 机器人运动学分析及仿真[J].制造业自动化，2016，38（3）：42-46，56.
[7] 周 晓 杰.AGV 系 统 及 引 导 方 式 发 展 趋 势 综 述[J].南 方 农 机 ，2017，48（4）：80.
[8] 覃尚活. 磁导航叉车式 AGV 控制导引系统的研究与开发[D].南宁：广西大学，2017.
[9] 顾俊，张宇.模糊控制的应用现状与发展趋势[J].化工自动化及仪表，2017，44（9）：811-812，902.
[10] Xiong B，Qu S R. Intelligent vehicle’s path tracking based onfuzzy control[J].Journal of Transportation Systems Engineering andInformation Technology，2010，10（2）：70-75文章来源于AGV吧