视觉码垛
本例用于纸箱或规则工件码垛。视觉作业返回工件位置偏差,PLC 在偏差有效且机器人就绪时发出抓取任务;垛型和示教点由项目参数定义。Darra 只做设备控制与握手,不承担库存或托盘业务管理。
适用能力
- SCL 与 LAD、6R 运动学、PTP/LIN/CIRC、示教点、碰撞检测和位置修正为当前能力。
- GigE/USB3 Vision 可用于工件定位;视觉推理必须异步完成,PLC 扫描不等待相机或模型。
- 离线仿真用于检查可达性和碰撞,但不替代真机安全。
配置口径
机器人型号、坐标、速度、负载、节拍和安全距离均为项目参数,必须在离线仿真与目标真机上分别验证。仿真通过不等于真机安全。
信号规划
| 符号 | 方向 | 用途 |
|---|---|---|
| BoxReady | 输入 | 来料箱到位 |
| VisionResultReady | 输入 | 定位结果完成 |
| OffsetXMillimeter | 输入 | X方向偏差 |
| OffsetYMillimeter | 输入 | Y方向偏差 |
| RobotReady | 输入 | 机器人就绪 |
| PickRequest | 输出 | 抓取任务请求 |
关键参数
| 参数 | 示例值 | 说明 |
|---|---|---|
| 最大修正量 | 机械参数 | 超范围拒绝任务 |
| 垛型 | 项目参数 | 层数与姿态按负载验证 |
| 真空确认超时 | 夹具参数 | 超时停止运动 |
SCL 逻辑示例
以下片段使用 Darra 规定的 C# 风格 SCL。变量应先在 Tag 或 DB 中声明并绑定,不要把示例名当成固定 API。
bool offsetValid = OffsetXMillimeter >= -MaxOffsetMillimeter && OffsetXMillimeter <= MaxOffsetMillimeter && OffsetYMillimeter >= -MaxOffsetMillimeter && OffsetYMillimeter <= MaxOffsetMillimeter;
bool safe = EStopOk && GuardClosed && RobotReady && VacuumSystemReady;
if (!safe) {
PickRequest = false;
PlaceRequest = false;
CellState = 99;
} else if (CellState == 0 && BoxReady && VisionResultReady && offsetValid) {
PickOffsetX = OffsetXMillimeter;
PickOffsetY = OffsetYMillimeter;
PickRequest = true;
CellState = 1;
} else if (CellState == 1 && PickDone && VacuumOk) {
PickRequest = false;
PlaceRequest = true;
CellState = 2;
} else if (CellState == 2 && PlaceDone) {
PlaceRequest = false;
LayerBoxCount = LayerBoxCount + 1;
CellState = 0;
}
调试与验收
- 核对相机坐标到机器人基坐标的标定。
- 用空载和低速验证每层姿态、可达性和碰撞。
- 模拟视觉超范围、真空丢失和托盘不到位。
边界与安全
- 不承诺无人值守、固定码垛速度或精度。
- 仿真通过后仍需现场安全审批、急停和围栏验证。
- 视觉结果超时或超范围不得当作有效抓取。