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

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

在RobotStudio中搭建数字孪生工作站，第一步不是写程序，而是把“机器人本体”和“工具”这两件事在虚拟环境里说清楚。本体决定了机器人的运动学尺寸、关节轴数、工作范围与可达空间；工具则决定了机器人末端真正参与作业的那个点在哪里、朝哪个方向、能承受多大负载。如果这两者建模不准，后续的轨迹规划、碰撞检测、节拍估算和离线程序都会建立在错误的基础上。本节围绕三个动作展开：导入机器人模型、定义工具坐标系TCP、验证工具姿态与负载数据。

一、导入机器人模型：从库到工作站

RobotStudio自带RobotWare配套的机器人库，导入方式通常有两种：一是通过“机器人模型”浏览器从本地库中按型号选择，二是从已有工作站或打包文件（.rslib）中拖入。导入时最关键的不是点击动作，而是确认三组信息：机器人型号与版本、安装方式（地面、倒挂、壁挂、倾斜）、以及到达姿态（Reach）。安装方式会直接改变机器人基坐标系的方向，例如倒挂安装时基坐标系的Z轴方向与地面安装相反，若选错，后续所有示教点都会整体翻转。

导入完成后，建议立即在“布局”中检查机器人本体的三个关键数据：到达距离（如IRB 2600-12/1.65表示负载12kg、到达距离1.65m）、轴数（通常6轴，部分协作机器人7轴）、以及本体质量与重心。这些参数来自RobotWare的机器人定义文件，不需要手动输入，但必须核对是否与实际现场一致。若现场机器人加装了走行轴或变位机，还需要在导入后建立外部轴与机器人的协调关系，否则本体模型只是一个孤立刚体。

导入机器人模型时，优先使用与现场RobotWare版本一致的机器人库。版本不一致可能导致运动学参数、关节限位或负载曲线存在细微差异，离线程序下发现场时容易出现偏差。

二、定义工具坐标系TCP：末端点的“身份”

TCP（Tool Center Point）是机器人末端工具上真正参与作业的那个点。它不是一个抽象概念，而是一个有位置、有姿态的坐标系。在RobotStudio中，TCP通过tooldata数据类型定义，包含tframe（工具坐标系相对于机器人法兰坐标系的位姿）和tload（工具负载）两部分。定义TCP的本质，就是回答两个问题：工具的工作点相对于法兰中心偏了多少、转了多少；工具本身有多重、重心在哪里。

实际定义时，常用方法有“四点法”“六点法”和“直接输入法”。四点法通过让工具尖端以四个不同姿态触碰同一个固定参考点，反算出TCP位置；六点法在此基础上增加姿态约束，可同时确定TCP方向。在RobotStudio中，如果工具模型已经按真实尺寸建模，可以直接在“建模”选项卡中创建工具坐标系，通过捕捉工具尖端和方向来定义tframe。例如一个焊枪工具，TCP通常定义在焊丝伸出端，Z轴沿焊枪轴线指向工件，X轴与机器人第六轴方向关联。

下面给出一个典型的tooldata示例，用于说明TCP定义的数据结构：

PERS tooldata tWeldGun := [
  TRUE,
  [[152.3, 0, 218.6], [0.7071, 0, 0.7071, 0]],
  [12.5, [80, 0, 120], [1, 0, 0, 0], 0, 0, 0]
];

其中第一行TRUE表示工具已激活；第二行[[152.3, 0, 218.6], [0.7071, 0, 0.7071, 0]]是tframe，即TCP相对于法兰的位置（单位mm）和姿态四元数；第三行[12.5, [80, 0, 120], ...]是tload，表示工具质量12.5kg、重心在工具坐标系下（80, 0, 120）mm处。这些数值必须来自实际工具测量或三维模型，不能随意填写。

三、验证工具姿态与负载数据

TCP定义完成后，必须验证两件事：姿态是否正确、负载是否合理。姿态验证的直观方法是使用RobotStudio的“TCP跟踪”功能，手动或通过程序让机器人以不同姿态运动，观察TCP是否始终围绕同一个空间点。如果TCP在运动中出现明显偏移，说明tframe的位置或姿态有误。另一种方法是使用“六点法”重新标定，对比新旧TCP的偏差量，一般要求位置偏差小于1mm、姿态偏差小于0.5°。

负载验证则要关注tload中的质量、重心和转动惯量。RobotStudio会根据tload计算机器人各轴的负载扭矩，并与RobotWare中的负载曲线对比。如果负载超出允许范围，软件会给出警告。实际验证时，可以在“机器人”属性中查看当前工具的负载利用率，通常建议不超过额定负载的80%。例如IRB 2600-12/1.65的额定负载为12kg，若工具质量12.5kg，已经超载，必须更换更大负载等级的机器人或减轻工具重量。

四、常见问题与处理建议

在实际项目中，TCP定义和负载验证常出现几类问题。第一类是TCP方向定义错误，例如焊枪Z轴方向与机器人法兰Z轴方向相反，导致程序中的姿态角全部反向。处理方法是重新检查工具坐标系的方向定义，确保Z轴指向作业方向。第二类是负载数据缺失或估算不准，很多现场只填写工具质量，忽略重心和转动惯量，导致机器人高速运动时出现抖动或报警。建议使用RobotStudio的“负载识别”功能，或通过实际称重和重心测量来完善tload。第三类是工具模型与TCP不一致，即三维模型中的工具尖端位置与tframe定义的位置存在偏差，这通常是因为建模时未按实际尺寸绘制，或导入时缩放比例不对。处理方法是重新测量工具实际尺寸，并在RobotStudio中修正模型或TCP。

TCP定义完成后，务必在“仿真”模式下让机器人以不同姿态运动，观察TCP轨迹是否平滑、是否与预期一致。不要仅凭数值判断，视觉验证往往能发现数值看不出的姿态问题。

五、本节小结

机器人本体与工具建模是数字孪生调试的起点。导入机器人模型时，要核对型号、安装方式和到达距离；定义TCP时，要准确填写tframe和tload，并理解每个数值的物理含义；验证阶段，要通过TCP跟踪和负载曲线对比，确认姿态正确、负载合规。只有这三步都做到位，后续的轨迹规划、碰撞检测和离线程序下发现场才有可靠的基础。