AGV(Automated Guided Vehicle)小车作为现代智能物流系统的核心执行单元,其稳定运行高度依赖于可靠的**plc程序**控制逻辑。本页面系统梳理AGV小车PLC程序开发全流程,涵盖电气设计、控制逻辑、传感器选型、路径规划、通讯接口、故障处理及安全规范等关键环节,面向自动化工程师、PLC编程人员及工业自动化集成商提供可落地的技术参考。
随着工业4.0与智能制造的深入推进,AGV在汽车制造、电商仓储、医药自动化、电子装配等场景中广泛应用。其核心——PLC程序——已从早期简单的继电器替代逻辑,发展为集多轴协同、多传感器融合、实时路径修正、故障自恢复于一体的智能控制体。尤其在多车协同调度系统(如FMS、WMS对接)中,PLC程序不仅需响应单台AGV动作指令,还需具备状态上报、任务队列解析、避障联动等高级功能。
典型AGV小车结构由车体底盘、驱动轮(双舵轮/差速轮/麦克纳姆轮)、导向系统(磁导航/激光SLAM/视觉导航)、安全防护(激光雷达/光电开关/急停按钮)、供电系统(锂电池+充电接口)、通讯模块(以太网/Modbus/PROFINET)及控制柜组成。其中,plc程序是连接硬件与上位系统的“神经中枢”,承担着实时数据采集、逻辑判断、执行输出及异常处理的全部职责。
本文以20kg载重、磁导航AGV小车为案例平台,详细拆解其PLC程序架构设计。所用PLC平台包括西门子S7-1200/S7-1500、三菱FX5U/QnU、欧姆龙NX1P2,支持TIA Portal、GX Works3、Sysmac Studio等主流开发环境。所有代码逻辑均通过实际产线验证,具备高可靠性与可迁移性。
一个完整AGV小车PLC程序应包含以下功能模块,各模块间通过全局变量或共享内存进行数据交互,确保逻辑清晰、便于维护:
包含手动模式(点动、急停复位)、自动模式(接收上位机指令)、远程/本地切换逻辑。关键点:
示例(TIA Portal STL伪代码):
// 启动条件检查
IF #BatteryVoltage > 24.0 AND
#ObstacleAlarm = FALSE AND
#NavSignalValid = TRUE THEN
#StartAllowed := TRUE;
ELSE
#StartAllowed := FALSE;
END_IF;
// 自动模式启动
IF #ModeSwitch = #AUTO AND
#StartAllowed AND
#StartButton THEN
#EnableDrive := TRUE;
#TaskState := #RUNNING;
END_IF;
根据导航系统反馈的路径点坐标,计算目标速度与转向角度,通过PID闭环控制驱动轮转速。差速驱动AGV需同步控制左右轮差速比:
典型PID参数(S7-1200):
| 参数 | 名称 | 典型值 | 说明 |
|---|---|---|---|
| Kp | 比例系数 | 1.2 | 响应速度,过大易振荡 |
| Ki | 积分时间 | 0.5s | 消除稳态误差 |
| Kd | 微分时间 | 0.02s | 抑制超调 |
| OutputLimit | 输出限幅 | ±80% | 防驱动器过载 |
磁导航AGV通过地埋磁钉获取位置信息,PLC需实时解析:
伪代码逻辑:
// 磁导航位置解析
IF #LeftMagnet = TRUE AND #RightMagnet = FALSE THEN
#Offset := -5; // 左偏5mm
ELSIF #LeftMagnet = FALSE AND #RightMagnet = TRUE THEN
#Offset := +5; // 右偏5mm
ELSE
#Offset := 0;
END_IF;
// 航向补偿
#CorrectedHeading := #RawHeading + (#Offset * 0.02); // 比例修正
与上位调度系统(WMS/WCS)通过PROFINET/Modbus TCP交互:
任务队列采用先进先出(FIFO)结构,程序需支持任务插入(紧急任务优先)与取消(人工干预)。队列长度建议不超过20项,避免内存溢出。
AGV依赖多类传感器实现环境感知与安全防护,PLC需对信号进行滤波、消抖与逻辑组合:
磁导航传感器:输出模拟量(4~20mA)或数字量(PNP/NPN),PLC需接入模拟量模块(如SM1231),进行线性化处理:
实际距离 = (RawValue - Offset) × ScaleFactor
典型Offset=1024(12位ADC),ScaleFactor=0.05mm/step
激光SLAM传感器:通过Modbus RTU输出位姿数据(X, Y, θ),PLC需解析寄存器数据(高16位+低16位组合):
// 读取激光雷达X坐标(寄存器40001) #X_H := %MW100; // 高16位 #X_L := %MW101; // 低16位 #X_mm := INT_TO_REAL(CONCAT(#X_H, #X_L)) * 0.1; // 单位:mm
| 传感器类型 | 安装位置 | PLC输入点 | 处理逻辑 |
|---|---|---|---|
| 激光雷达 | 车头/车尾 | I0.0~I0.3 | 当检测距离<300mm时,置位#SafetyAlarm |
| 光电开关 | 货叉两侧 | I0.4~I0.5 | 检测到障碍物时暂停搬运动作 |
| 急停按钮 | 车体四角 | I0.6(安全回路) | 直接切断Q0.0(驱动使能) |
| 碰撞开关 | 缓冲器内部 | I0.7 | 触发后自动后退500mm |
电池电量计算公式(简化版):
RemainingTime(h) = (BatteryCapacity(Ah) × 0.8 × Voltage(V)) /
(AverageCurrent(A) × 1.2)
其中1.2为安全系数,避免过放。当剩余时间<30分钟时,PLC自动发送“低电量报警”至调度系统。
发现长期运行后磁钉定位偏差累积达±15mm,新增“动态校准模块”:每通过3个磁钉进行一次航向角重校准,偏差控制至±3mm内。
引入“传感器投票机制”:当激光雷达与磁导航数据偏差>50mm时,触发“模式切换”——暂停自动运行,切换至手动校正模式。
在急停信号输入端增加RC滤波电路+软件延时(100ms),避免振动误触发,故障率下降72%。
AGV路径规划分为全局路径(上位系统生成)与局部路径(PLC实时修正)两级。PLC程序需支持:
路径由一系列坐标点构成,PLC程序维护路径表(DB块):
TYPE PathPoint :
STRUCT
X_mm : REAL;
Y_mm : REAL;
Theta_deg : REAL;
Speed_mm_s : REAL;
Action : INT; // 0=直行, 1=停靠, 2=旋转
END_STRUCT
END_TYPE
VAR
PathTable : ARRAY[1..50] OF PathPoint;
CurrentPoint : INT := 1;
END_VAR
程序循环读取当前点,计算目标方向角:
#DeltaX := #PathTable[#CurrentPoint].X_mm - #CurrentX; #DeltaY := #PathTable[#CurrentPoint].Y_mm - #CurrentY; #TargetAngle := ATAN2(#DeltaY, #DeltaX); // 弧度转角度
当检测到障碍物时,PLC执行:
绕行路径生成算法(简化版):
IF #ObstacleDetected THEN
#PathOffset := 400; // 车宽800mm,偏移400mm
#NewX := #CurrentX + #PathOffset * COS(#CurrentAngle);
#NewY := #CurrentY + #PathOffset * SIN(#CurrentAngle);
#DetourTarget := #CurrentPoint + 1;
END_IF;
在交叉路口,PLC通过无线网桥交换位置信息:
避让规则:低优先级AGV(任务ID大者)主动停车等待,高优先级保持航向。
| 点号 | X(mm) | Y(mm) | θ(°) | 速度(mm/s) | 动作 |
|---|---|---|---|---|---|
| 1 | 0 | 0 | 0 | 600 | 启动 |
| 2 | 1200 | 0 | 0 | 600 | 直行 |
| 3 | 1200 | 800 | 90 | 300 | 左转 |
| 4 | 600 | 800 | 180 | 400 | 停靠装货 |
时间轴(单位:ms):
AGV与上位系统通讯是PLC程序的关键环节,常用协议如下:
寄存器分配表(功能码03/06):
| 地址 | 变量名 | 数据类型 | 读写 | 说明 |
|---|---|---|---|---|
| 40001 | CurrentX | REAL | 只读 | 当前X坐标(mm) |
| 40003 | CurrentY | REAL | 只读 | 当前Y坐标(mm) |
| 40005 | Heading | REAL | 只读 | 航向角(度) |
| 40010 | TaskID | REAL | 只写 | 任务编号(0=无任务) |
| 40012 | StartX | REAL | 只写 | 起点X坐标 |
注意:REAL类型占2个寄存器(高16位+低16位),需按Modbus规范进行字节序转换。
使用CIP协议,PLC作为Scanner:
使用定时器(T1)监控通讯超时:
IF #ComOK = FALSE THEN
#ComTimer(IN:=TRUE, PT:=T#10S);
IF #ComTimer.Q THEN
#AlarmLevel := 1;
END_IF;
END_IF;
重连后自动校验路径同步性:
IF #Reconnected THEN
#ExpectedX := #LastValidX + (#Speed * #TimeDelta);
#PositionError := ABS(#CurrentX - #ExpectedX);
IF #PositionError > 100 THEN
#ForceRecalibrate := TRUE;
END_IF;
END_IF;
AGV常见故障及PLC程序应对策略:
现象:AGV突然停驶,HMI显示“导航异常”
可能原因:
PLC诊断逻辑:
// 磁导航信号有效性检测
IF (#LeftMagnet = FALSE AND #RightMagnet = FALSE) THEN
#NavLossCount := #NavLossCount + 1;
ELSIF (#LeftMagnet = TRUE AND #RightMagnet = TRUE) THEN
#NavLossCount := 0;
END_IF;
IF #NavLossCount > 5 THEN // 持续5次扫描无信号
#NavValid := FALSE;
#StopReason := "导航信号丢失";
END_IF;
典型报警代码(以西门子G120为例):
| 报警码 | 中文含义 | PLC响应动作 |
|---|---|---|
| P0005 | 参数读取失败 | 重启驱动器(断电10s) |
| F0001 | 过电流 | 停止驱动,记录电流峰值 |
| F0005 | 过电压 | 检查制动电阻,降速运行 |
| F0010 | 欠电压 | 立即停机,检查电池电压 |
PLC通过DRF(诊断读取功能)读取驱动器状态:
// 读取驱动器状态字(地址1001)
DRD_DG(EN:=TRUE, ID:=1, LADDR:=1001, RET_VAL:=#DrivStatus);
IF #DrivStatus <> 0 THEN
#DriveAlarm := TRUE;
END_IF;
场景:AGV到达终点后不执行装货动作
诊断步骤:
程序增加“任务超时监控”:
// 每个任务设定最大执行时间(如300s)
IF #TaskState = #RUNNING THEN
#TaskTimer(IN:=TRUE, PT:=T#300S);
IF #TaskTimer.Q THEN
#TaskTimeout := TRUE;
#StopReason := "任务超时";
END_IF;
END_IF;
某汽车厂AGV集群故障统计(100台/半年):
AGV安全设计必须符合以下标准:
PLC需通过安全继电器实现以下安全回路:
安全程序示例(S7-1200 Safety Instructions):
// 安全停止逻辑
SFTIN(
EN:=#EmergencyStop,
OUT:=#SafeStopRequest
);
// 安全输出控制
SFTOUT(
EN:=#SafeStopRequest,
OUT:=#EnableDrive_Safety
);
人机协作场景(如协作AGV)需满足:
PLC通过限制速度设定值实现:
// 协作模式速度限制
IF #CollaborativeMode THEN
#SpeedLimit := 500; // mm/s
ELSE
#SpeedLimit := 1200;
END_IF;
#ActualSpeed := MIN(#RequestedSpeed, #SpeedLimit);
AGV本体需张贴:
程序文档必须包含安全相关说明,例如:
“本程序中#SafeStopRequest信号为安全关键变量,其逻辑路径已通过SIL2认证,禁止在非安全开发环境中修改。”
某项目未使用安全继电器,急停按钮直接接入PLC输入点:
以下问题均来自AGV技术论坛、知乎、百度知道等平台高频提问,结合实际案例解答:
答:常见于差速驱动AGV,原因有三:
优化方案:在路径点表中插入“转向预加速点”:
// 在90°转弯前插入减速点
IF #CurrentPoint = 2 THEN // 转弯点
#SpeedSet := 200; // 提前减速
END_IF;
答:累积误差来源:
答:需设计“死锁检测”机制:
答:典型AGV程序(含导航、驱动、任务、安全):
答:不推荐。原因:
仅适用于教学演示或轻载(<2kg)实验平台。