多机器人单元
本例展示多机器人单元的控制组织:每台机器人维护独立的就绪、忙、完成和故障状态,共享工位由 PLC 发放互斥许可。适合装配、搬运或焊接单元。离线碰撞检查不能替代围栏和急停。
适用能力
- 6R、SCARA、Delta 等运动学可在同一 Windows 硬实时项目中使用。
- PTP/LIN/CIRC、示教点、离线仿真和碰撞检测可用。
- PLC 通过状态变量协调,不复制机器人运行状态。
配置口径
机器人型号、坐标、速度、负载、节拍和安全距离均为项目参数,必须在离线仿真与目标真机上分别验证。仿真通过不等于真机安全。
信号规划
| 符号 | 方向 | 用途 |
|---|---|---|
| RobotReady[] | 输入 | 各机器人就绪 |
| RobotBusy[] | 输入 | 各机器人执行中 |
| RobotDone[] | 输入 | 各机器人任务完成 |
| SharedZoneClear | 输入 | 共享区空闲 |
| RobotPermit[] | 输出 | 进入共享区许可 |
关键参数
| 参数 | 示例值 | 说明 |
|---|---|---|
| 机器人数量 | 项目配置 | 示例不固定台数 |
| 共享区互斥 | 硬线+逻辑 | 任意时刻只发一张许可 |
| 碰撞间隙 | 项目参数 | 仿真间隙不能替代现场安全距离 |
SCL 逻辑示例
以下片段使用 Darra 规定的 C# 风格 SCL。变量应先在 Tag 或 DB 中声明并绑定,不要把示例名当成固定 API。
bool cellSafe = EStopOk && GuardClosed && SharedZoneSensorOk;
if (!cellSafe) {
for (int robot = 0; robot < RobotCount; robot = robot + 1) {
RobotPermit[robot] = false;
}
CellFault = true;
} else {
CellFault = false;
bool zoneGranted = false;
for (int robot = 0; robot < RobotCount; robot = robot + 1) {
bool grant = !zoneGranted && SharedZoneClear && RobotReady[robot] && RobotTaskPending[robot];
RobotPermit[robot] = grant;
zoneGranted = zoneGranted || grant;
}
}
调试与验收
- 逐台独立运行后再开放共享区。
- 验证任意时刻只有一台机器人获得共享区许可。
- 在仿真和真机低速下覆盖交叉路径与故障恢复。
边界与安全
- 仿真通过不等于真机安全。离线碰撞检查不能替代围栏、光幕、急停和安全控制。
- 不承诺固定机器人数量、节拍、力控精度或工艺专用功能块。
- 单元只协调设备许可,不在 PLC 内做工单或工艺质量业务。