📚 课程目录第3章机器人本体与工具建模

3. 机器人本体与工具建模

在 RobotStudio 中开始任何可达性分析或布局优化之前，必须先让虚拟工作站里的机器人“站对位置、拿对工具”。机器人本体决定了工作空间的几何边界，工具则决定了实际作业点（TCP）相对法兰盘的位置与姿态。两者共同构成后续可达性判断的几何基础。本节围绕三件事展开：从机器人库中正确选型并导入本体、创建与实际一致的几何工具、定义并验证工具坐标系（TCP）。

一、从库中选择机器人：先看数据，再看外形

RobotStudio 的机器人库按厂商、系列、型号、到达距离和负载分类。选择时不要只凭外观或型号名称，而应核对四项关键参数：最大到达距离（reach）、额定负载（payload）、安装方式（落地/倒挂/壁挂）以及本体版本（如 IRB 6700-235/2.65 中的 235 表示负载 235 kg，2.65 表示到达距离 2.65 m）。这些参数直接决定后续可达性分析的上限。

导入方式有两种：一是通过“机器人库（Robot Library）”浏览并拖入工作站；二是若已有实际机器人的备份或 .rslib 文件，可直接导入以保持与实际一致。导入后建议立即在“布局（Layout）”浏览器中确认机器人名称、基坐标系原点位置和默认姿态。示例：某搬运工位选用 IRB 6700-235/2.65，落地安装，基座原点位于地面，默认姿态为各轴 0°。此时机器人法兰盘中心位于基座正上方约 0.78 m 处（具体值以模型为准），这是后续工具安装的参考点。

选型提示：若实际机器人是倒挂安装，导入后需在“机器人属性”中把安装方式改为“倒挂（Suspended）”，否则工作空间方向会与实际相反，可达性结论将完全错误。

二、创建自定义工具：几何与坐标系分开做

库中自带的工具（如焊枪、吸盘）往往与实际现场工具尺寸不符，因此需要创建自定义工具。RobotStudio 中创建工具有两条路径：

导入外部 CAD 模型：将实际工具的 .sat、.step 或 .stl 文件导入，作为“设备（Equipment）”添加到工作站。这种方式几何最真实，适合碰撞检测和离线编程。
用基本体搭建：在“建模（Modeling）”选项卡中用圆柱、长方体等基本体组合出工具外形，适合快速验证或没有 CAD 数据的场景。

无论哪种方式，工具几何创建完成后，它只是一个“挂在法兰上的物体”，还没有定义 TCP。工具坐标系必须单独定义，且应尽量与现场标定结果一致。定义 TCP 的本质是：给出工具坐标系原点（TCP）相对机器人法兰坐标系（通常为 tool0）的平移量 (x, y, z) 和旋转量 (rx, ry, rz)。

示例：一个真空吸盘工具，吸盘中心相对法兰盘沿法兰 Z 轴向外偏移 180 mm，吸盘轴线与法兰 Z 轴重合。则 TCP 定义为：

平移：x = 0 mm, y = 0 mm, z = 180 mm
旋转：rx = 0°, ry = 0°, rz = 0°
工具名称：tGripper
所属机器人：IRB6700_235_265__01

若工具存在偏置角度，例如焊枪倾斜 15°，则需在旋转量中体现。RobotStudio 中可在“工具坐标系（Tool Coordinate System）”对话框中直接输入数值，也可通过“从点创建（Create from Points）”用示教点反算。对于已有现场标定数据的项目，优先直接输入标定值，避免重复标定引入误差。

三、工具坐标系定义与验证：用姿态变化暴露错误

定义完成后必须验证，否则一个符号错误就会让整个可达性分析失效。验证的核心思路是：让机器人以不同姿态到达同一个空间点，观察 TCP 是否始终重合。若 TCP 定义正确，无论机器人如何改变姿态，工具尖端都应指向同一点；若存在偏差，则说明平移或旋转量有误。

RobotStudio 中常用的验证方法有三种：

手动关节运动观察：在“手动关节（Manual Joint）”模式下，缓慢改变 4、5、6 轴姿态，观察工具尖端是否围绕同一点转动。若尖端画圈，说明 TCP 位置偏了。
用“TCP 跟踪”功能：在仿真中让机器人走一段包含姿态变化的轨迹，开启 TCP 轨迹显示，检查轨迹是否平滑且与预期路径一致。
四点法/六点法验证：若现场已用四点法标定，可在 RobotStudio 中复现四个示教点，检查反算出的 TCP 是否与输入值一致。示例：四点法标定得到 TCP 为 (2.1, -0.8, 179.6)，与理论值 (0, 0, 180) 偏差在 2 mm 以内，可认为标定有效；若偏差超过 5 mm，应检查标定点是否共面或机器人是否松动。

常见错误：把工具坐标系建在了法兰盘上而不是工具尖端，或把旋转方向搞反。前者会导致所有作业点整体偏移一个工具长度，后者会让工具在姿态变化时“甩”向错误方向。验证时务必让机器人做至少两个差异较大的姿态。

验证通过后，建议把工具保存为 .rslib 或 .xml 模板，便于在其他工作站复用。同时记录工具名称、TCP 数值、创建日期和对应机器人型号，形成可追溯的工具库。这样在后续章节做可达性分析和布局优化时，才能保证“机器人 + 工具”这一组合的几何模型与实际一致，分析结论才有工程意义。

完成上述建模后，工作站中就有了一个几何正确、TCP 明确的“机器人 + 工具”组合。后续的可达性分析、奇异点检查、布局优化，都建立在这一组合之上。若工具或 TCP 有误，再精细的路径规划也只是在错误模型上做无用功。因此，本节的三步——选型、建工具、验 TCP——是整门课程最基础也最不能省略的工程动作。