www.xservx.com|AGV小车PLC程序开发中心|专注工业自动化控制

AGV小车PLC程序开发全流程权威指南

AGV(Automated Guided Vehicle)即自动导引运输车,其控制系统的核心是PLC(Programmable Logic Controller),负责接收导航指令、解析路径信息、驱动电机执行、实现安全联锁与状态反馈。一套成熟的AGV小车PLC程序不仅需满足基础运动控制,还必须深度集成电磁导航、激光SLAM、惯性导航等多种定位方式的数据融合,同时兼容RS-485、CAN总线、EtherCAT、Profinet等工业通信协议,确保在多车协同、动态避障、任务调度等复杂场景下稳定运行。

本页面系统梳理AGV小车PLC程序开发的关键技术点,涵盖硬件选型、软件架构设计、核心控制算法、通信协议解析、故障自诊断逻辑、安全冗余机制、调试优化经验等模块,结合主流PLC平台(西门子S7-1200、三菱FX5U、台达ES2/EX3系列)提供可落地的编程实践方案,为工业自动化工程师提供即查即用的技术参考。

特别说明:AGV小车PLC程序开发需严格遵循《GB/T 3836.1-2021 爆炸性环境 第1部分:设备 通用要求》《GB/T 3836.4-2021 爆炸性环境 第4部分:由本质安全型“i”保护的设备》等安全标准,确保在危险环境中的电气安全性能。实际部署前务必进行型式试验与第三方安全认证。

一、AGV小车PLC系统核心架构解析

1.1 系统层级划分

标准AGV控制系统采用三层架构:

  1. 感知层:激光雷达、电磁导引传感器、惯性测量单元(IMU)、编码器、限位开关、光电传感器等,实时采集环境与本体状态数据。
  2. 控制层:PLC作为主控单元,运行运动控制算法,处理传感器输入,生成驱动指令,协调各子系统工作。
  3. 执行层:伺服驱动器、直流无刷电机、液压/气动执行机构、声光报警器、无线通信模块(4G/5G/WiFi)等。

PLC程序需实现数据采集→逻辑判断→指令输出的闭环控制链,典型周期时间≤20ms。

1.2 关键硬件选型原则

模块推荐型号选型要点
主控PLC西门子S7-1214C DC/DC/DC支持高速脉冲输出(HSC+PTO),I/O点≥24入/16出,具备以太网口
伺服驱动三菱MR-J4W系列支持EtherCAT总线,定位精度±0.01mm,响应频率≥1kHz
激光雷达SICK LMS100-20500测距范围0.1~20m,扫描频率25Hz,IP67防护
安全PLC倍福CX9020嵌入式控制器冗余架构,符合PLd/SIL2标准,双通道急停回路

1.3 PLC程序模块化设计

采用功能块(FB)与组织块(OB)分离的设计模式:

  • OB1:主循环,调用各功能块
  • FB10:导航数据解析模块(处理SLAM地图坐标)
  • FB20:运动控制模块(S曲线加减速规划)
  • FB30:通信协议模块(Modbus TCP/RTU)
  • FB40:故障诊断模块(状态机+错误码生成)
  • FB50:安全联锁模块(急停、碰撞检测、区域禁入)

模块间通过结构体(UDT)传递数据,确保接口清晰、维护便捷。例如导航数据结构体UDT_NavData包含:当前位姿(X,Y,θ)、目标点坐标、路径段编号、障碍物距离列表等字段。

二、AGV主流通信协议深度解析

2.1 协议对比与选型建议

AGV与上位系统(WMS/MES)及多车调度平台通信时,常用协议包括:

  • Modbus TCP/RTU:工业基础协议,配置简单,适用于单机控制,最大节点数32
  • CANopen:基于CAN总线,实时性强,适用于多电机协同,波特率最高1Mbps
  • Profinet:西门子生态专用协议,支持同步实时通信,延迟≤1ms
  • EtherCAT:开源协议,支持分布式时钟,同步精度±1μs,适用于高动态场景
  • OPC UA:平台无关协议,支持加密与认证,适用于跨系统集成

2.2 Modbus TCP指令详解

PLC作为Modbus TCP服务器,典型功能码配置如下:

FC1: 读保持寄存器(地址40001起)
40001: 当前状态(0=空闲,1=运行,2=故障,3=充电)
40002: 任务ID(0=无任务)
40003: X坐标(单位mm)
40004: Y坐标(单位mm)
40005: 航向角(单位0.01°)
40006: 电池电量(%)
40007: 故障码(0=无故障)
40008: 安全状态(0=正常,1=急停触发)

FC6: 写单个寄存器(地址40011起)
40011: 目标X坐标
40012: 目标Y坐标
40013: 目标航向
40014: 运行速度(mm/s)
40015: 加速度(mm/s²)
40016: 任务指令(0=无,1=取货,2=放货)

注意:寄存器地址需与上位系统协商统一,避免地址冲突。建议使用16位无符号整数(UINT16)存储坐标,需乘以比例系数(如10)提升精度。

2.3 CANopen协议对象字典配置

以DS401标准为例,关键对象如下:

0x6040: 控制字(Controlword)
bit0: 启动(1=使能)
bit1: 停止(1=急停)
bit2: 清除故障(1=复位)

0x6060: 操作模式(Mode of Operation)
1=Profiles Position Mode
3=Homing Mode

0x607C: 目标位置(Target Position)
32位有符号整数,单位脉冲

0x6041: 状态字(Statusword)
bit15: 电机使能
bit14: 内部限位触发
bit13: 外部限位触发

PLC程序需定期轮询状态字,当检测到“内部限位触发”位时,立即暂停运动并记录故障位置坐标。

三、AGV核心控制逻辑与算法实现

3.1 运动控制策略

AGV运动模型主要分为三类:

  1. 差速驱动:双轮差速转向,结构简单,转向半径为0,但稳定性较差
  2. 阿克曼转向:前轮转向+后轮驱动,转向平滑,适用于高速场景
  3. 全向驱动:麦克纳姆轮/ omnidirectional轮,可平移+旋转,灵活性高,但能耗大

本节以差速驱动为例,说明PLC中的S曲线加减速控制实现:

// S曲线速度规划伪代码(T为周期时间)
IF StartMove THEN
v_target := TargetSpeed;
a_max := MaxAccel;
j_max := MaxJerk;
// 计算加加速度阶段持续时间
t_jerk := a_max / j_max;
// 计算匀加速阶段距离
s_acc := 0.5 * a_max * t_jerk * t_jerk;
// 判断是否进入匀速段
IF s_total > 2 * s_acc THEN
v_cruise := v_target;
ELSE
v_cruise := SQRT(s_total * j_max * a_max);
END_IF;
// 生成速度曲线数组
FOR i := 0 TO Steps DO
t := i * T;
IF t < t_jerk THEN
v[i] := 0.5 * j_max * t * t * t / T;
ELSIF t < 2 * t_jerk THEN
v[i] := s_acc / t_jerk + a_max * (t - t_jerk) - 0.5 * j_max * (t - t_jerk)^2 / T;
ELSIF t < T_total - 2 * t_jerk THEN
v[i] := v_cruise;
ELSIF t < T_total - t_jerk THEN
v[i] := v_cruise - a_max * (t - (T_total - 2 * t_jerk)) + 0.5 * j_max * (t - (T_total - 2 * t_jerk))^2 / T;
ELSE
v[i] := 0.5 * j_max * (T_total - t)^2 * t / T;
END_IF;
END_FOR;
END_IF;

PLC中需将速度曲线预生成为数组,每周期读取对应速度值,通过PID调节电机转速,确保轨迹平滑。

3.2 导航路径跟踪算法

以激光SLAM生成的路径点序列为例,PLC需实现路径插值与跟踪:

  1. 路径预处理:将离散路径点拟合为B样条曲线,减少转向突变
  2. 最近点搜索:计算当前位姿与路径上各点欧氏距离,定位最近点
  3. 横向误差计算:Δy = (x - x_ref)·sinθ - (y - y_ref)·cosθ
  4. 航向误差计算:Δθ = θ_path - θ_current
  5. PD控制律:
    v = v_base - k_p * Δy - k_d * Δy'
    ω = k_θ * Δθ

参数整定经验:
k_p = 0.08~0.12(单位:s⁻¹)
k_d = 0.02~0.05(单位:s)
k_θ = 0.3~0.6(单位:s⁻¹)

3.3 多车协同避障逻辑

当AGV数量≥3时,需引入分布式协同避障机制:

  • 栅格地图共享:每台AGV将自身位置与速度广播至邻近车辆(半径50m),形成局部地图
  • 时间窗冲突检测:预测未来3s运动轨迹,若两车时间窗重叠且空间距离<0.8m,则触发避让
  • 优先级协商:基于任务紧急度(WMS下发优先级)+当前电量(低电量车让行)动态调整
  • 安全缓冲区:前方0.5m设为红色缓冲区,后方0.3m为黄色缓冲区,进入后强制降速

PLC中需维护邻近车辆列表(最多8台),每200ms更新一次,采用时间戳机制剔除失效数据。

四、AGVPLC程序故障诊断与自恢复机制

4.1 故障分类与诊断逻辑

典型故障类型及PLC诊断逻辑:

故障类型诊断条件处理措施
编码器断线速度反馈持续为0且电机电流>50%额定值停机并记录故障点坐标,触发蜂鸣器报警
激光雷达通信丢失3个连续周期未收到雷达数据帧切换至电磁导引模式(若硬件支持),降速至0.3m/s
电池电压过低BMS反馈电压<24V且电量<15%暂停任务,自动导航至充电位,发送充电请求
急停回路断开安全PLC输入I0.7为0立即切断电机使能,进入安全停机状态
路径跟踪偏差横向误差|Δy|>200mm持续2s重新规划路径或请求人工干预

4.2 故障码编码规则

采用五位数字编码:X-YY-ZZZ
- X:故障大类(1=机械,2=电气,3=导航,4=通信,5=安全)
- YY:子类(如01=电机故障,02=驱动器故障)
- ZZZ:具体错误编号

示例:3-02-017 表示导航子系统中激光SLAM地图匹配失败

4.3 自恢复策略

PLC程序需实现分级自恢复逻辑:

  • 一级恢复:通信丢包→重发3次,失败则切换备用通信通道
  • 二级恢复:路径跟踪偏差→暂停1s,重新计算最近路径点
  • 三级恢复:电池电压低→进入低功耗模式,关闭非必要模块
  • 四级恢复:急停触发→需人工复位,PLC记录故障日志

所有恢复操作需记录至EEPROM(断电不丢失),支持事后追溯分析。

五、AGV安全机制与冗余设计

5.1 三级安全防护体系

1. 硬件级安全:
- 双回路急停按钮(常闭触点串联)
- 安全光栅(检测距离0.3~4m)
- 机械限位开关(行程末端硬限位)

2. PLC安全逻辑:
- 安全PLC独立扫描周期(≤10ms)
- 安全功能块(如FB_SafetyStop)采用双CPU冗余校验
- 故障时强制断开安全继电器(如Phoenix PT-SPM系列)

3. 软件级防护:
- 任务队列优先级校验(防冲突调度)
- 速度限制(空载≤1.5m/s,负载≤1.0m/s)
- 区域禁入(通过电子围栏实现,坐标范围写入PLC常量表)

5.2 安全PLC与主PLC协同机制

典型通信方式为PROFIsafe协议,关键数据交互:

主PLC → 安全PLC:
- 当前运行速度(范围0~1500mm/s)
- 任务状态(0=待机,1=执行中)

安全PLC → 主PLC:
- 安全状态(0=正常,1=急停触发,2=光栅遮挡)
- 故障码(16位安全错误代码)

双向校验:
- 每周期交换随机数(防信号冻结)
- 超时检测(>20ms无响应则触发安全停机)

5.3 安全测试规范

部署前必须完成以下安全测试:

  • 急停按钮响应时间≤150ms(从按下至电机断电)
  • 光栅遮挡后,AGV在0.5m内停车
  • 电子围栏边界处,AGV提前1.2m降速至0.2m/s
  • 电池电压跌至24V时,30秒内自动充电指令触发
  • 多车交叉路口,采用“右让左、空让载”原则

六、主流PLC平台AGV程序实战案例

西门子S7-1200
三菱FX5U
台达ES2

S7-1200 AGV控制程序要点

  • 使用TIA Portal V17,程序结构:OB1 → FB10(导航)→ FB20(运动)→ FB30(通信)
  • 导航数据处理:调用SLAM_Trajectory_Interpolation功能块,将栅格地图转换为B样条曲线
  • 运动控制:采用ServoDrive_PID功能块,支持S曲线加减速,PID参数在线调整
  • 通信协议:使用TCP_IP_Server功能块实现Modbus TCP服务,支持10个客户端连接
  • 安全逻辑:通过SafeStop_DB数据库管理安全状态,输入I0.7(急停)直接触发安全输出Q0.0
// 典型任务调度逻辑(OB1中调用)
CASE TaskStatus OF
0: // 等待新任务
IF NewTaskAvailable THEN
TaskID := NextTaskID;
TaskStatus := 1;
END_IF;
1: // 解析目标点
TargetX := TaskData[0];
TargetY := TaskData[1];
TargetTheta := TaskData[2];
TaskStatus := 2;
2: // 启动路径规划
IF NavReady THEN
Call FB20(Mode:=1, TargetPos:=[TargetX,TargetY,TargetTheta]);
TaskStatus := 3;
END_IF;
3: // 运行中监控
IF FB20.Done THEN
TaskStatus := 4;
ELSIF FB20.Error THEN
TaskStatus := 5;
END_IF;
4: // 任务完成
TaskComplete := TRUE;
TaskStatus := 0;
5: // 故障处理
LogError(FaultCode:=FB20.ErrorCode);
TaskStatus := 6;
6: // 等待人工干预
IF ManualReset THEN
TaskStatus := 0;
END_IF;
END_CASE;

三菱FX5U AGV控制程序要点

  • 使用GX Works3,程序结构:PRC程序 + 任务调度表(每2ms扫描一次)
  • 导航处理:使用SLAM_Lib库函数,支持激光雷达原始数据解析
  • 运动控制:调用MR_J3_PID_S指令,支持位置/速度/力矩模式切换
  • 通信协议:使用Modbus_TCP_Slave指令,寄存器映射表配置在工程文件
  • 安全逻辑:通过Safety_Module模块实现,支持安全停止(STO)与安全限速(SS1)
// 导航路径跟踪(每20ms执行)
// 输入:CurrentX, CurrentY, CurrentTheta
// 输出:CmdSpeed, CmdAngle
// 中间变量:ErrY, ErrTheta, v_cmd, w_cmd

// 计算最近路径点
MinDist := 10000;
FOR i := 0 TO PathLength-1 DO
dx := PathX[i] - CurrentX;
dy := PathY[i] - CurrentY;
dist := SQRT(dx*dx + dy*dy);
IF dist < MinDist THEN
MinDist := dist;
RefIndex := i;
END_IF;
END_FOR;

// 计算横向误差
ErrY := (CurrentX - PathX[RefIndex]) * SIN(PathTheta[RefIndex]) - (CurrentY - PathY[RefIndex]) * COS(PathTheta[RefIndex]);

// 计算航向误差
ErrTheta := PathTheta[RefIndex] - CurrentTheta;
IF ErrTheta > PI THEN
ErrTheta := ErrTheta - 2*PI;
ELSIF ErrTheta < -PI THEN
ErrTheta := ErrTheta + 2*PI;
END_IF;

// PD控制
v_cmd := BaseSpeed - 0.1 * ErrY - 0.03 * (ErrY - LastErrY) / 0.02;
w_cmd := 0.5 * ErrTheta;

CmdSpeed := v_cmd;
CmdAngle := w_cmd;
LastErrY := ErrY;

台达ES2 AGV控制程序要点

  • 使用ISPSoft V3.10,采用模块化编程,主程序调用各功能模块
  • 导航功能:使用AGV_NavLib,支持电磁导引+二维码导航双模切换
  • 运动控制:调用MC_Power、MC_MoveAbsolute指令,支持电子齿轮模式
  • 通信协议:使用EtherNet_IP功能块,适配ODVA标准
  • 安全逻辑:通过Safety_Function实现,支持Safe Stop(STO)与Safe Limited Speed(SLS)
// 电池电压监控逻辑
// 输入:ADC_Volt(0-10V对应0-30V电池)
// 输出:LowVoltFlag, ChargeReq

VoltValue := ADC_Volt * 3.0; // 转换为实际电压(单位:V)

IF VoltValue < 24.5 THEN
LowVoltFlag := TRUE;
ChargeReq := TRUE;
// 降速至0.5m/s
MaxSpeed := 500;
ELSIF VoltValue < 22.0 THEN
LowVoltFlag := TRUE;
ChargeReq := TRUE;
// 强制停机
EnableMotor := FALSE;
ELSE
LowVoltFlag := FALSE;
ChargeReq := FALSE;
MaxSpeed := 1000;
END_IF;