2. MOTOMAN机器人运动学基础

节拍优化的第一步不是调速度,而是把“机器人到底在哪里、以什么姿态、把哪个点送到哪里”这件事说清楚。MOTOMAN 机器人的运动学基础由四个相互关联的概念构成:关节轴决定机器人自身的可动自由度,TCP决定“工具末端真正作用的点”,工具坐标系决定这个点相对于法兰的姿态与偏移,用户坐标系决定这个点在工件或工位中的位置基准。四者一旦定义不一致,后续所有节拍计算都会出现系统性偏差。

关节轴:节拍的时间来源

MOTOMAN 六轴机器人通常记为 S、L、U、R、B、T 轴,分别对应回转、下臂、上臂、腕部回转、腕部摆动和腕部扭转。每个轴都有三个关键参数:最大速度、最大加速度和允许的加加速度(Jerk)。节拍的本质,是各轴在“从当前关节角运动到目标关节角”的过程中,受这三项限制所消耗的时间总和。

以一段典型的 PTP 关节运动为例,若某轴需要转动 60°,最大速度 180°/s,加减速时间各 0.15 s,则梯形速度曲线下的时间约为:加速段 0.15 s 走 13.5°,匀速段走 33° 约 0.183 s,减速段 0.15 s 走 13.5°,合计约 0.483 s。若该轴是整段运动中最慢的“瓶颈轴”,则整段 PTP 节拍就由它决定。这说明节拍优化往往不是让所有轴都快,而是识别并压缩瓶颈轴。

TCP 与工具坐标系:把“作用点”定义准确

TCP(Tool Center Point)是工具实际工作的那个点,例如焊枪的焊丝端点、吸盘的吸附中心、涂胶嘴的出胶口。工具坐标系则是在法兰坐标系基础上,通过平移 (x, y, z) 和旋转 (Rx, Ry, Rz) 描述 TCP 的位置与姿态。MOTOMAN 的 TOOL 数据通常以六维参数记录,例如:

TOOL 01: X=120.0mm Y=0.0mm Z=180.0mm
         Rx=0.0°  Ry=90.0°  Rz=0.0°

这表示 TCP 位于法兰前方 120 mm、下方 180 mm 处,且工具绕 Y 轴旋转了 90°。若这个定义写错,机器人会“以为”自己把焊丝送到了焊缝,实际却偏了 120 mm。更隐蔽的问题是姿态:TCP 位置正确但 Rx/Ry/Rz 错误时,直线运动中的姿态插补会带着工具一起偏转,导致焊缝扭曲或吸盘倾斜漏气。

用户坐标系:把“工件位置”变成基准

用户坐标系(User Frame)是相对于机器人基坐标系的工件或工位基准。MOTOMAN 中常用 UF 数据定义,例如把工件原点设在夹具定位销上,X 轴沿工件长边,Z 轴垂直向上。这样编程时所有示教点都相对于工件描述,工件挪动后只需重新标定 UF,程序无需逐点修改。

节拍计算中,用户坐标系影响的是“运动距离”和“姿态变化量”。同一个 TCP 点,在基坐标系下可能是一条斜线,在用户坐标系下可能是一条沿 X 轴的直线。直线运动与关节运动的时间模型不同:直线运动需要笛卡尔插补并做逆解,节拍通常比 PTP 长;而用户坐标系定义准确时,可以把原本需要绕行的路径改成沿工件边的直线,从而减少无效行程。

四者与节拍计算的耦合关系

把四者放在一起看,节拍计算链条是:用户坐标系给出目标点在工件中的位置 → 工具坐标系把 TCP 偏移和姿态叠加到法兰 → 逆运动学求出各关节轴的目标角度 → 按各轴速度/加速度限制计算运动时间 → 取瓶颈轴时间作为该段节拍。任何一环定义错误,都会让“计算出的节拍”与“实际节拍”不一致。

MOTOMAN 运动学四要素与节拍计算链路 用户坐标系 UF 工件/工位基准 决定目标点位置 工具坐标系 TOOL TCP 偏移 + 姿态 决定法兰到作用点 关节轴 S L U R B T 速度/加速度/Jerk 决定运动时间 节拍 瓶颈轴时间 + 逻辑等待 逆运动学求解 + 插补方式选择 PTP 关节插补 / MOVL 直线插补 / MOVC 圆弧插补 节拍计算示例(假设参数) S轴:60° / 180°/s → 0.483 s L轴:30° / 150°/s → 0.320 s U轴:45° / 160°/s → 0.405 s R轴:90° / 200°/s → 0.600 s ← 瓶颈 瓶颈轴 = R轴 0.600 s 整段 PTP 节拍 ≈ 0.600 s 优化方向:降低 R 轴转角 或调整工具姿态减少腕部负担

实际标定与验证:让定义与现场一致

在 MOTOMAN 示教器上,TCP 标定常用“五点法”或“六点法”:让工具末端以不同姿态触碰同一个固定参考点,控制器根据多组法兰位姿反算出 TCP 的 x、y、z 和姿态。用户坐标系则常用“三点法”:示教原点、X 轴方向点和 Y 轴方向点,控制器据此建立 UF。标定完成后,应做一次验证:在 UF 下让 TCP 沿 X 轴走 100 mm,用直尺测量实际位移,偏差应控制在 0.5 mm 以内;再让 TCP 绕 Z 轴旋转 90°,观察工具末端是否绕自身轴线旋转而非画圆。

标定顺序建议:先标 TCP,再标 UF。因为 UF 的验证往往需要 TCP 作为“探针”,TCP 不准会污染 UF 的标定结果。

节拍计算中的常见陷阱

  • TCP 姿态与运动指令不匹配:用 MOVL 走直线时,若 TCP 的 Rx/Ry/Rz 定义与工具实际安装方向差 90°,机器人会以错误姿态插补,导致实际路径偏离,节拍计算中的“直线距离”失效。
  • 用户坐标系未随工件更新:工件换型后 UF 未重标,所有示教点整体偏移,机器人可能为了到达“错误的目标点”而多走一段路,节拍被无形拉长。
  • 只看单轴速度,忽略加速度:短距离运动中,加速度限制往往比速度限制更早成为瓶颈。例如 10° 的小角度转动,速度还没到最大值就要减速,实际时间由加速度决定。
  • 把 PTP 节拍直接当作 MOVL 节拍:PTP 是关节空间运动,各轴独立走梯形曲线;MOVL 是笛卡尔空间直线运动,需要持续逆解并协调各轴,通常更慢。节拍估算时必须区分指令类型。

从运动学到节拍优化的判断依据

当现场节拍不达标时,可以按以下顺序排查:先确认 UF 和 TOOL 是否与当前工件、工具一致;再查看示教点是否在 UF 下描述、是否存在不必要的姿态变化;然后读取各轴运动时间,找出瓶颈轴;最后判断瓶颈轴是受速度限制还是加速度限制。若瓶颈轴是腕部 R/B/T 轴,通常说明工具姿态或 TCP 偏移让腕部负担过重,可通过调整工具安装角度或改用更靠近工件的 TCP 定义来缓解。若瓶颈轴是 L/U 大臂,则更多与工作空间布局和路径规划有关。