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 示教器上,TCP 标定常用“五点法”或“六点法”:让工具末端以不同姿态触碰同一个固定参考点,控制器根据多组法兰位姿反算出 TCP 的 x、y、z 和姿态。用户坐标系则常用“三点法”:示教原点、X 轴方向点和 Y 轴方向点,控制器据此建立 UF。标定完成后,应做一次验证:在 UF 下让 TCP 沿 X 轴走 100 mm,用直尺测量实际位移,偏差应控制在 0.5 mm 以内;再让 TCP 绕 Z 轴旋转 90°,观察工具末端是否绕自身轴线旋转而非画圆。
节拍计算中的常见陷阱
- TCP 姿态与运动指令不匹配:用 MOVL 走直线时,若 TCP 的 Rx/Ry/Rz 定义与工具实际安装方向差 90°,机器人会以错误姿态插补,导致实际路径偏离,节拍计算中的“直线距离”失效。
- 用户坐标系未随工件更新:工件换型后 UF 未重标,所有示教点整体偏移,机器人可能为了到达“错误的目标点”而多走一段路,节拍被无形拉长。
- 只看单轴速度,忽略加速度:短距离运动中,加速度限制往往比速度限制更早成为瓶颈。例如 10° 的小角度转动,速度还没到最大值就要减速,实际时间由加速度决定。
- 把 PTP 节拍直接当作 MOVL 节拍:PTP 是关节空间运动,各轴独立走梯形曲线;MOVL 是笛卡尔空间直线运动,需要持续逆解并协调各轴,通常更慢。节拍估算时必须区分指令类型。
从运动学到节拍优化的判断依据
当现场节拍不达标时,可以按以下顺序排查:先确认 UF 和 TOOL 是否与当前工件、工具一致;再查看示教点是否在 UF 下描述、是否存在不必要的姿态变化;然后读取各轴运动时间,找出瓶颈轴;最后判断瓶颈轴是受速度限制还是加速度限制。若瓶颈轴是腕部 R/B/T 轴,通常说明工具姿态或 TCP 偏移让腕部负担过重,可通过调整工具安装角度或改用更靠近工件的 TCP 定义来缓解。若瓶颈轴是 L/U 大臂,则更多与工作空间布局和路径规划有关。