☰
玻璃搬送机器人控制逻辑:从CC-Link信号协议到非接触Alignment的工程实践
2026/10/28 10:48:22 网站建设 项目流程

简介:这份资源是Sankyo Robot SP6500工业机器人的中文说明书,面向玻璃搬送产线的设备调试、维护工程师及自动化集成人员,用于解决SP6500控制系统在玻璃搬送应用中的参数配置、信号分配与故障排查问题。资源包共1个PDF文件,约5.2MB,内容涵盖硬件构成示例、Command处理Program Flow、标准I/O信号分配、CC-Link分配一览表,以及Hand I/O Port分配、碎裂检测、吸着确认、Hand Position Sensor检测等功能说明,并附有从6000.00.x.A到6500.01.x.A各版本的改订履历,便于读者对照现场机型确认功能差异。目前已有10496人学习下载,适合需要快速查阅SP6500控制逻辑、I/O定义与版本变更细节的工程师作为案头参考。

1. 玻璃搬送机器人的控制逻辑:为什么一份规格书比代码更值得读

一台玻璃搬送机器人出故障,现场工程师第一反应往往是查机械、换传感器、重启控制器。但真正让产线停摆的,常常不是硬件坏了,而是上位 PLC 和机器人控制器之间对某个信号的理解出现了偏差——机器人认为“我已经吸住了”,PLC 认为“你还没确认”,双方各等各的,超时报警。Sankyo SP6500 这类玻璃搬送机器人的规格书,本质上就是一份“双方约定”的完整记录:CC-Link 的每一个 bit 代表什么、Command 的每一个参数怎么编码、异常 Code 从 01h 到 37h 分别对应哪种物理状态。搞懂这份约定背后的设计逻辑,比会按复位按钮有用得多。它解决的核心问题是:在高速搬送场景下,如何用一套确定性的信号协议,把“吸着、检测、对齐、放片”这些物理动作翻译成 PLC 能可靠判读的电平序列。

2. Command 处理流程:一条指令从 PLC 到机械臂经历了什么

2.1 指令不是“发过去就执行”,而是三段式握手

很多人以为 PLC 给机器人发一个动作 Command,机器人就开始动。实际流程要复杂得多。从规格书的 Command 处理 Program Flow 来看,一条指令的生命周期至少分三段:PLC 先写动作 Mode 设定信号和 Command 用信号,机器人侧在 Cyclic 通信周期内读到这些 bit 后做参数合法性校验,校验通过才进入 Motion 执行,执行完毕再回写完成 ACK。这个三段式结构的关键在于“校验前置”——如果 Position Code、Address Code、Worktype Code 任何一个值越界,机器人直接抛 20h、27h、28h、29h 这类参数异常,而不是带着错误参数去撞片。

常见的实现思路是,控制器内部维护一张 Command 状态机表,每个 Command 对应一组前置条件(比如 Z 轴是否在安全高度、Hand 是否有片),条件不满足就拒绝执行并置对应 Error Code。这样做的好处是故障可定位:现场看到 20h 就知道是 Teach Data 里指定的 Position 没有数据,不用去猜机械问题。

2.2 信号分配表为什么按“输入/输出 × User 区域”切这么多段

规格书第 4 章把 CC-Link 的 IO 分配拆成了 4.1.1 到 4.1.14 共十几张表,输入输出交替排列。乍看很啰嗦,但这恰恰反映了 CC-Link 的底层约束:Cyclic 通信的 Remote I/O 区域是有限且按站分配的,User 区域能用的 bit 数取决于 CC-Link Card 的 Version 设定。6500.00 版本把 CC-Link 设定变更到 Version 2.0、扩展 Cyclic 2 倍,就是为了在同样的站数下塞进更多 User bit。换句话说,那些分段表不是随便切的,而是“一个 Version 2.0 的 Cyclic 帧能承载多少 User 字”这个物理上限的直接映射。

我一般会这么理解:把 4.1.x 的每一段看成一次 Cyclic 刷新里的一组寄存器窗口,PLC 侧编程时按窗口偏移去读写,就不会出现“信号串位”这种玄学问题。血泪经验是,改 CC-Link Version 设定后如果没同步改 PLC 侧的偏移地址,机器人收到的 Command 会整体错位一个字,表现就是“动作完全对不上号”。

2.3 Data Register 与 IO 的分工:连续量走寄存器,开关量走 bit

规格书 4.2 单独列了 Data Register 的输入输出分配,这背后是一个清晰的分工原则:像 Position 编号、Speed 档位、Slot 参数这类需要传数值的量走 Data Register(16 位字),而“启动、停止、吸着确认”这类二值状态走 IO bit。为什么不全用寄存器?因为 bit 的刷新和判读在 PLC 扫描周期里更直接,联锁逻辑用 bit 写起来干净;而数值量用 bit 拼会浪费大量地址且容易在跨字边界时出错。这个分工在 6.3 动作指定 Parameter 的显示里体现得最明显——Command 本身是 bit 触发,但 Command 带的参数是从寄存器读的。

提示:调试时先确认 Data Register 的 Offset(规格书 5.9 有专门一节),Offset 配错会让所有数值参数整体平移,现象是“动作能跑但位置全偏”。

3. 吸着与碎裂检测:传感器信号如何变成可判读的状态

3.1 吸着确认不是“吸盘有负压”这么简单

规格书 5.8 吸着信号和 6.13 吸着确认无效 Parameter 放在一起看,能看出设计者的取舍。吸着确认的原始逻辑是:发出吸着指令后,在约定时间内检测真空/压力开关是否到位,不到位就抛 04h(R1 Chuck 基板吸着异常)或 0Ah(R2)。但实际产线上,薄玻璃或带涂层的片子有时压力开关响应慢半拍,硬等就会误报。于是 6000.01 版本加了“吸着确认无效 Parameter”——允许针对特定 Work Type 关掉吸着确认的硬判读,改由后续的在荷检测兜底。这是一个典型的“用可配置性换鲁棒性”的设计:默认严格,特殊工况可放宽,但放宽的代价是异常发现时机后移。

3.2 碎裂检测与在荷检测为什么要拆成两个独立功能

6000.03 版本的改订记录写得很清楚:“Glass 碎裂检测功能、在荷检测独立功能追加”。早期版本里,碎裂检测和在荷检测是耦合的——传感器读到一个异常值,分不清是“片碎了”还是“片没送到”。拆开之后,碎裂检测走 Glass corner check Sensor(5.11),在荷检测走独立的在荷 Sensor,两者各自有独立的判定阈值和 Error Code(031 版本专门加了碎裂检测用 Error)。这个拆分的动机很实际:碎裂和在荷缺失的处置动作完全不同,前者要立即停机防止碎片扩散,后者可以重试取片。混在一起判,就只能一刀切停机,损失产能。

3.3 Hand Position Sensor 与 Origin Sensor 的异常分级

6000.04 版本追加了 Hand Position Sensor Error 和 Origin Sensor Error。这两个 Sensor 的异常在 Error Code 表里没有单独占一个大段,而是融进了 1D/1E(Glass Shift err)和原点复位相关逻辑。设计上的考虑是:Hand Position Sensor 检测的是 Hand 上片子有没有偏移,偏移超限抛 1D/1E;Origin Sensor 检测的是各轴原点是否可信,原点不可信时原点复位动作(6.9 节)会受限。把这两类归到“位置可信度”范畴而不是“动作执行失败”范畴,是为了让上位系统能区分“片子放歪了但机器人没坏”和“机器人自己找不到原点了”这两种完全不同的故障等级。

4. 非接触 Alignment:没有物理接触,怎么把片子摆正

4.1 Sensing 动作的本质是“用传感器边缘反推片子边缘”

规格书第 8.3 节把非接触 Alignment 按传感器布置方式分成了四种:R 轴方向用 Hand 部 Alignment Sensor、X 轴方向用固定式 Alignment Sensor、X 轴方向用 Hand 部 Sensor、X 轴方向用 Line Sensor。四种方式的共同原理是:机器人带着片子(或片子静止、传感器移动)扫过传感器视场,记录传感器 ON/OFF 跳变时的机器人坐标,用跳变点反推片子边缘位置,再算出 X/Y/θ 补偿量。区别只在于传感器装在哪、扫描轨迹怎么走。比如 Line Sensor 方式(6.11 节)一次扫描能拿到一整条线的边缘信息,适合快速粗对齐;Hand 部 Sensor 方式精度更高但需要多次点位扫描。

4.2 补偿量异常为什么要单独设 2C/2D/2E 三个 Error Code

2C(θ 轴补偿量不合适)、2D(Y 轴补偿量不合适)、2E(X 轴补偿量不合适)这三个 Code 的存在,说明 Alignment 计算出的补偿量不是“算出来就直接用”,而是要先过一道范围校验。原因很直接:如果片子放得离谱(比如斜了 30 度),算出的 θ 补偿量会超出机器人关节的安全旋转范围,直接执行会撞机械限位。所以控制器在算出补偿量后,先和 Teaching Data 里设定的可接受范围比对,超范围就抛对应轴的 Error,让上位决定是重取片还是人工干预。这个“算—校验—再执行”的三步,是非接触 Alignment 能安全跑在产线上的关键。

4.3 Line Sensor 的 X 轴 Sensing:信号指定与 Command 指定为什么并存

6.11.1 节专门讨论了“通过信号指定”和“通过 Command 指定”两种 Line Sensor Sensing 方式的差异。这不是功能重复,而是两种使用场景:信号指定方式适合 PLC 在 Cyclic 通信里直接触发一次扫描,响应快、逻辑简单;Command 指定方式适合需要带参数(扫描范围、速度、判定阈值)的复杂扫描,走完整的 Command 握手流程。并存的设计动机是让简单场景不被复杂协议拖慢,复杂场景不被简单接口限制。踩坑点在于:两种方式共用同一组 Line Sensor 硬件,如果 PLC 侧同时用两种方式触发,会出现扫描结果互相覆盖,表现为 23h(Line Sensor Error)或 24h(Line Sensor Area Over)。

5. 避坑与排查:现场最容易翻车的几个点

5.1 现象:动作 Command 发下去,机器人不动也不报错

原因:Command 一致信号(Command Unmatch)超时逻辑在起作用。规格书 1Fh 是“Command 一致信号输入 Over Timer 异常”,但如果在超时前 PLC 又撤掉了 Command bit,机器人侧可能既没执行也没来得及抛 1Fh,表现为“静默忽略”。解决:确认 PLC 侧 Command bit 的保持时间大于机器人侧的最小采样窗口,且不要在 ACK 回来之前反复翻转 Command bit。

5.2 现象:换了 CC-Link Card 后所有位置整体偏移

原因:CC-Link Version 设定变更(比如从 1.0 升到 2.0 扩展 Cyclic 2 倍)后,User 区域的字地址映射变了,但 PLC 侧偏移没同步改。解决:对照规格书 4.1 各分段表的起始地址重新核对 PLC 侧 Data Register 和 IO 的 Offset(5.9 节),改完做一次空载 Command 验证。

5.3 现象:薄片频繁报 04h 吸着异常,厚片正常

原因:吸着确认的判定窗口对薄片响应偏慢,压力开关还没稳定就被判失败。解决:按 6.13 节对薄片对应的 Work Type 启用吸着确认无效 Parameter,同时确认在荷检测独立功能已开启,用后续在荷检测兜底。

5.4 现象:Alignment 后片子位置反而更歪

原因:2C/2D/2E 补偿量校验范围设得过宽,算出的补偿量虽然没超机械限位,但已经超出工艺可接受范围,执行后片子被“纠正”到错误位置。解决:收紧 Teaching Data 里各轴补偿量的可接受范围,让超范围时抛 Error 而不是硬执行。

5.5 现象:原点复位后 Z 轴或 R 轴停在奇怪位置

原因:6.9 节明确写了 Z 轴、R 轴原点复位的可能范围是受限的,如果复位前轴停在范围外,复位动作会走到边界就停,且不一定抛 Error。解决:原点复位前先确认各轴在允许复位区间内,必要时先手动(或低速 Command)把轴移回区间。

6. 版本演进里的设计取舍:为什么 6500 要重写 CC-Link 设定

翻完从 6000.00 到 6500.01 的改订履历,会发现一个有意思的节奏:6000 系列一直在“加功能”——加碎裂检测、加 Single Hand 对应、加 Hand 前进待机、加基板纵横指定;而 6500.00 做的是“换底座”——CC-Link 设定变更到 Version 2.0、扩展 Cyclic 2 倍。这个顺序不是随意的。功能越加越多,User 区域的 bit 和寄存器需求持续膨胀,6000 系列靠零敲碎打地调整分配表已经快撑不住了,所以 6500 先把通信带宽翻倍,再在 6500.01 上继续加“基板纵横指定功能”和“在荷确认仕样变更”。换句话说,6500 不是功能版本,是容量版本,它的价值在于给后续功能留出地址空间。

这个取舍对使用者的启示是:如果你手上的设备还在 6000 系列且功能已经够用,不必急着升 6500;但如果你需要基板纵横指定或在荷确认的新仕样,就必须先过 6500.00 这道通信底座的门槛,因为新功能的信号位在 6000 的地址空间里根本排不下。另一个值得注意的细节是 6000.021 版本修的“两 Hand 指定动作时 Position 指定不良规正”——双 Hand 机器人指定动作时,两个 Hand 的 Position 参数如果指向同一组 Teach Data 但实际上下 Hand 数据不一致,会抛 21h(上下 Hand 的 Teach Data 不一致异常)。这个修正说明双 Hand 场景下 Teach Data 的一致性校验是后来补上的,早期版本在这块是有盲区的。

从那以后我每次接手一份设备规格书,都强制先把改订履历从头到尾读一遍,因为功能列表告诉你“它能做什么”,而改订履历告诉你“它曾经在哪里翻过车、后来怎么补的”——后者才是现场排查时真正能救命的信息。希望帮到你。

本文还有配套的精品资源,点击获取

需要专业的网站建设服务?

联系我们获取免费的网站建设咨询和方案报价,让我们帮助您实现业务目标

立即咨询