第四章：机械手控制——TCP/IP Socket通讯实战
各位工程师朋友，今天我们来聊一个很实在的话题——用TCP/IP Socket控制机械手。
说实话，我在自动化行业摸爬滚打十几年，机械手通讯这块踩过的坑真不少。早期用串口，后来用Profibus，再到现在几乎清一色的以太网。你想想看，一条网线就能搞定几百米外的机械手，多方便。
但方便归方便，Socket通讯的坑也不少。我记得第一次调试ABB机械手和西门子PLC通讯时，就因为字符串结尾少了个换行符，折腾了整整一个下午。嗯，今天就把这些经验分享给大家。
4.1 通讯架构概览
先看整体架构。说白了，就是PLC作为客户端，机械手作为服务器。
核心逻辑：
- PLC主动发起连接请求
- 机械手监听固定端口（通常是2000或3000）
- 双方通过字符串指令交互
- PLC发指令 → 机械手执行 → 返回状态
我习惯把这种模式叫做"一问一答"。PLC发一条指令，机械手回一条状态。简单、可靠、容易排查问题。
4.2 指令协议设计
协议设计是重中之重。我见过太多项目因为协议没定好，现场调试时鸡飞狗跳。
我个人推荐的指令格式：
| 指令方向 | 格式 | 示例 | 说明 |
|---|---|---|---|
| PLC→机械手 | CMD 参数1 参数2 \r\n | MOVE 100 200 \r\n | 移动至坐标(100,200) |
| 机械手→PLC | 状态码:信息 \r\n | OK:MOVED \r\n | 执行成功 |
| 机械手→PLC | ERR:错误码 \r\n | ERR:OUT_OF_RANGE \r\n | 坐标超限 |
💡 经验之谈：
字符串结尾一定要带\r\n。我曾经遇到一个项目，机械手厂家文档写的是\n，结果实际设备只认\r\n。现场改程序？不存在的，只能PLC这边加个换行符转换。
4.3 抓取与放置指令集
机械手抓取放置，核心就几个动作。我习惯把它们封装成标准指令集：
- MOVE X Y Z — 移动到指定坐标
- GRIP 1 — 夹爪闭合（抓取）
- GRIP 0 — 夹爪张开（放置）
- HOME — 回原点
- STATUS — 查询当前状态
你想想看，是不是很简单？但实际项目中，指令的时序控制才是关键。
⚠️ 注意：
机械手执行指令需要时间。比如GRIP 1指令发出去，夹爪完全闭合可能需要0.5秒。PLC不能立刻发下一条指令，必须等机械手返回"OK"状态。
我见过有人用延时等待，结果机械手动作慢了半拍，工件直接掉地上。正确的做法是等待状态反馈。
4.4 PLC端Socket编程（西门子S7-1200示例）
以西门子S7-1200为例，它自带的TSEND_C和TRCV_C指令就能搞定TCP通讯。
先看连接建立：
// 建立TCP连接
"TCON_IP4".CONNECT := 1; // 触发连接
// 配置参数：
// 服务器IP: 192.168.1.200
// 端口: 2000
// 本地端口: 自动分配
// 等待连接建立
IF "TCON_IP4".DONE THEN
"Connected" := TRUE;
END_IF;发送指令：
// 发送"GRIP 1\r\n"
"TSEND".REQ := TRUE;
"TSEND".DATA := "GRIP 1\r\n";
"TSEND".LEN := 8; // 字符串长度
// 发送完成标志
IF "TSEND".DONE THEN
"SendDone" := TRUE;
END_IF;接收响应：
// 接收机械手返回的状态
"TRCV".EN_R := TRUE;
"TRCV".DATA := "ReceiveBuffer";
"TRCV".LEN := 256; // 缓冲区大小
// 收到数据后处理
IF "TRCV".NDR THEN
// 解析返回字符串
// 判断是"OK"还是"ERR"
"ResponseOK" := FIND("ReceiveBuffer", "OK");
END_IF;关键点：
- 发送前检查连接状态
- 发送后等待DONE位
- 接收时注意缓冲区大小
- 字符串解析用FIND或MID指令
4.5 完整抓取流程示例
来，我们走一遍完整的抓取流程。假设工件在坐标(100, 200, 50)处：
- PLC发：
MOVE 100 200 50\r\n - 机械手回：
OK:MOVED\r\n - PLC发：
GRIP 1\r\n - 机械手回：
OK:GRIP_CLOSED\r\n - PLC发：
MOVE 300 400 100\r\n（放置位置） - 机械手回：
OK:MOVED\r\n - PLC发：
GRIP 0\r\n - 机械手回：
OK:GRIP_OPENED\r\n
嗯，每一步都要等确认。我习惯在PLC里做一个状态机，用STEP计数器控制流程：
CASE "Step" OF
0: // 移动到抓取点
"SendCmd" := "MOVE 100 200 50\r\n";
"Step" := 1;
1: // 等待移动完成
IF "ResponseOK" THEN
"Step" := 2;
END_IF;
2: // 夹爪闭合
"SendCmd" := "GRIP 1\r\n";
"Step" := 3;
3: // 等待夹爪到位
IF "ResponseOK" THEN
"Step" := 4;
END_IF;
// ... 后续步骤
END_CASE;💡 避坑指南：
我曾经在状态机里忘记复位"ResponseOK"标志，结果第二步直接跳过了。现场机械手还没到位，夹爪就闭合了，工件被夹偏。从那以后，我每个步骤结束都手动复位所有标志位。
4.6 异常处理与重连机制
网络通讯嘛，断连是家常便饭。PLC这边必须做好断线重连。
我的做法是：
- 用心跳包检测连接状态（每5秒发一次STATUS指令）
- 如果连续3次无响应，判定断连
- 自动触发重连流程
- 重连成功后，先发HOME指令让机械手回原点
⚠️ 重要提醒：
重连后不要直接继续之前的动作。机械手可能还在半空中，直接发MOVE指令会出事故。我习惯先回原点，再重新规划路径。
4.7 调试技巧
最后分享几个调试技巧：
- 用网络调试助手 — 先模拟机械手，验证PLC发的指令对不对
- 抓包分析 — Wireshark看实际收发的数据，确认有没有多余字符
- 日志记录 — PLC里记录每次收发的内容，出问题好回溯
- 超时设置 — 接收超时设3秒，别让PLC死等
说实话，TCP/IP控制机械手并不复杂。把协议定清楚，状态机写严谨，异常处理做到位，基本就稳了。我这些年经手的项目，凡是出问题的，十有八九是协议没对齐或者时序没控制好。
嗯，今天就聊到这儿。记住一句话：通讯协议是双方的约定，不是单方面的自嗨。和机械手厂家对好协议，现场调试能省一半时间。
公众号:蓝海资料掘金营，微信deep3321