一种磁导式AGV小车PLC控制系统的设计-AGV吧

随着AGV（Automated Guided Vehicle)产品和技术的不断发展，可以得生产工序或产线之间通过AGV进行高效连接，提高了自动化水平和生产效率，促进了工业柔性生产线、自动化物流系统的实现。本文主要介绍一种磁导式AGV小车控制系统，该AGV小车为全国职业院校工业机器人技术应用赛项中的一个组成单元，属于磁条导航方式的自动导引车，主要实现机器人沿着地面铺设的磁条行驶，往返于立体仓库与产线之间完成取送货任务。

1控制系统构成

AGV小车采用磁导式循线方式，通过前后安装的循迹传感器使小车沿着地面铺设好的轨迹驱动电机行走；行走电机采用二台直流无刷电机，实现差速控制，定位精准。AGV机器人上部为平带输送装置，采用步进电机驱动，实现与产线或立库的对接与运送货物。

小车寻迹PLC控制系统主要由以下几部分组成；主控单元采用西门子S7-1200PLC；前后各安装有一个磁导航传感器和地标传感器组成循迹传感器；磁导航循迹传感器内部间隔10mm平均排布8个采样点，能够检测出磁条上方100高斯以下的微弱磁场，每一个采样点都有一路信号对应输出。AGV运行时，磁导航传感器内部垂直于磁条上方的连续1~4个采样点会输出信号，依靠输出的这几路信号，可以判断磁条相对于导航传感器的偏离位置，据此AGV会自动作出调整，确保沿磁条前行。地标传感器检测地面横向布置的磁条信号，并以此信号完成小车的减速和停车控制。

小车电机采用两台直流无刷电机，通过对应的两台直流无刷电机驱动器进行差速驱动，以保证小车按照铺设好的磁条轨迹前后运行。无刷电机使能（EN）、制动（BK）、方向（FR）控制端连接PLC输出端子，电机转速通过PLC模拟量通道0~10V电压输出进行调节控制。

小车寻迹PLC控制系统结构及直流电机驱动电路示意图如图1所示。

2设备组态

打开TIA Portal V13SP1编程软件，完成设备组态。CPU选择 CPU 1215C DC ／ DC ／ DC，数字量扩展模块选择 DI 16 ／DQ 16 X24VDC。组态界面如图 2 所示。

3 程序编写

3．1 程序结构

程序编写按照模块化编程的思路，将整体功能细分为相应的子任务，即子程序，也称为程序块；然后通过组织块（主程序）进行块与块间的调用来组织程序，模块化的程序结构便于程序的修改、检查和调试。

按照系统实际功能要求，将系统程序结构设计如图 3 所示。

整个程序主要由物理输入／输出程序块（FB1）、使能控制、制动控制和方向控制程序块（FB2）和运动控制程序块（FB3）组成。

其中物理输入／输出程序块（FB1）主要将 AGV 机器人的输入单元，即车体上的前后寻迹传感器、主令电器等的输入点转存到 PLC 内部存储器中，这样有利于程序编写和使用；该块主要完成一是检测 AGV 机器人巡线传感器与贴在地上磁线的相对位置，方便及时进行调整；二是判断 AGV 机器人是否运动到前后的限位，作出减速或停止的判断；三是输出相应的状态指示，如指示灯等。

使能控制、制动控制和方向控制程序块（FB2）主要实现根据外部的信号指令，驱动两台直流无刷电机，保证小车按照铺设好的磁条轨迹前后运行。电机的运转状态是通过使能控制、制动控制和方向控制配合实现的；当需要小车前、后运动时，PLC 对两台直流无刷电机驱动器进行控制，接通驱动器使能信号，解除制动控制，然后输入方向控制信号，就可以驱动电机转动，从而实现 AGV 小车运行。

运动控制程序块（FB3）是 AGV 小车控制系统中最重要的一个程序块；该块要实现小车行进过程中偏离度的检测与计算、根据偏离度采用 PID 控制方式计算两台电机的转速，通过调节两台电机的转差快速完成纠偏动作，使小车能够始终沿着铺设的磁条轨迹准确运行。下面主要介绍运动控制程序块的编写思路。

3．2 运动控制程序块

3．2．1 偏离度检测与计算

偏离度的检测主要是检测小车与磁条轨迹之间的偏离程度；当 AGV 小车居中运行时，寻迹传感器中间的 3、4、5、6 号灯点亮；当出现偏移时，寻迹传感器状态会相应变化，如当只有 3、4、5 点亮时，说明小车向右侧偏移；同样当只有 4、5、6 点亮时，说明小车向左侧偏移。小车偏移状态示意图如图 4 所示。

这样我们就可以根据寻迹传感器的显示状态将偏离度分为8 级；级数越高，说明小车偏离磁条轨迹越远。小车偏离程度状态检测对应表如表 1 所示；仅列出小车前进时右侧偏移对应表，左侧偏移度及后退左右偏移度检测方法与该表一致，不再列写。

当检测到小车偏离度后，我们就可以根据偏离程度进行计算，这时就可以确定出 PID 调节中的 P 参数；当偏离度越高，AGV 左右轮电机差速值应该越大，需要尽快将小车调整回到磁道的中间位置。

两台电机转差值的调节方式，是首先根据 PID 参数值计算出转速差 Δn；然后根据小车偏移方向，去调整两侧电机的转速；如小车右偏，偏移度为 3，我们可以先计算出 PID．P 调节量，即仅按偏移度计算的转差 Δn，然后将右侧电机 M2 转速调整为V＋Δn，将左侧电机 M2 转速调整为 V－Δn。偏移度越大，与基本量相乘后数值越大，转差 Δn 越大，两台电机差速调节效果越明显。具体计算程序如图 5 所示，其中 PID．P 系数为人为设置的基本调节量。