3. UR机器人坐标系与运动学基础

在UR协作机器人柔性装配单元中，机器人要完成“抓取—移动—插入—拧紧”这类动作，前提是它知道“自己在哪里、工具在哪里、工件在哪里”。这三件事分别由基坐标系、工具坐标系和工件坐标系描述。UR的控制系统内部以基坐标系为绝对参考，所有运动指令最终都要换算到基坐标系下执行；而工具坐标系（TCP）和工件坐标系则是面向任务的“相对参考”，让编程和标定更贴近实际装配对象。

三个坐标系的角色与关系

基坐标系（Base）固定在机器人底座中心，原点位于底座安装面中心，Z轴向上，X轴指向机器人正前方（以UR默认安装方向为准）。它不随机器人运动而改变，是机器人各关节角度与末端位姿换算的公共基准。工具坐标系（Tool）固定在末端法兰所装工具上，其原点即TCP（Tool Center Point），通常定义在夹爪指尖中心、吸盘吸附面中心或拧紧轴轴线上。工件坐标系（Work Object）固定在夹具或工件上，用于把“在工件上打孔”“沿工件边缘涂胶”这类任务描述成工件局部坐标，避免每次工件位置微调都重写程序。

三者关系可以概括为：基坐标系是“世界”，工具坐标系是“手”，工件坐标系是“活”。机器人运动指令中的位姿，既可以用基坐标系表达（如 movej(p[0.3,0.1,0.4,0,3.14,0])），也可以用工件坐标系表达（如 movej(get_actual_tcp_pose()) 配合工件偏移）。当工件坐标系被激活后，程序中的位姿会先经工件坐标系变换，再经工具坐标系变换，最终落到基坐标系执行。

TCP设置：从法兰到工具尖端

TCP设置的本质是求出工具坐标系原点在法兰坐标系中的位置和姿态。UR提供多种标定方法，柔性装配单元中最常用的是“四点法”和“六点法”。四点法只求TCP位置（x、y、z），姿态沿用默认方向；六点法在四点基础上增加两个姿态点，同时求出TCP的旋转分量（rx、ry、rz），适合对工具方向有严格要求的拧紧、插装任务。

以四点法为例，操作步骤如下：在示教器上进入“安装→TCP→新建”，选择“四点法”；将工具尖端以四种不同姿态触碰同一个固定参考点（如夹具上的锥孔或标定针尖），每触碰一次记录一个点。四个点必须来自不同姿态，且姿态差异越大，解算越稳定。UR内部用最小二乘拟合球心，球心即为TCP在基坐标系中的位置，再换算到法兰坐标系。示例参数：若四个点记录的法兰位姿分别为 p1=[0.30,0.10,0.40,0,0,0]、p2=[0.32,0.12,0.38,0.3,0.2,0.1]、p3=[0.28,0.14,0.42,-0.2,0.3,-0.1]、p4=[0.31,0.09,0.41,0.1,-0.3,0.2]（单位：米/弧度，仅为教学示例），解算后TCP偏移约为 [0.00,0.00,0.12,0,0,0]，表示工具尖端在法兰Z轴正方向120 mm处。

六点法在此基础上增加两个点：将工具分别绕X轴和Y轴旋转一定角度后触碰同一点，用于确定TCP姿态。标定完成后，示教器会显示TCP的六维参数，并给出残差（偏差值）。残差通常应小于0.5 mm，若超过1 mm，说明触碰点不准确或姿态差异不足，需要重新标定。

工件坐标系标定：三点法与直接输入

工件坐标系标定常用“三点法”：在工件上选取一个原点、一个X轴方向点、一个Y轴方向点。原点确定工件坐标系原点，X轴方向点确定X轴正方向，Y轴方向点确定XY平面。UR根据三点计算工件坐标系相对于基坐标系的变换矩阵。示例：原点 O=[0.50,0.00,0.20]，X方向点 Px=[0.60,0.00,0.20]，Y方向点 Py=[0.50,0.10,0.20]（单位：米，教学示例），则工件坐标系X轴沿基坐标系X正方向，Y轴沿基坐标系Y正方向，Z轴由右手定则确定。

若工件由夹具精确定位，也可直接输入工件坐标系相对基坐标系的位姿，或通过“工件坐标系向导”用机器人触碰工件上的基准面、基准孔来建立。对于柔性装配单元，建议将工件坐标系与夹具定位销关联，这样更换工件时只需重新标定一次，程序中的工件局部坐标无需修改。

验证：让标定结果可判断

标定完成后必须验证，否则错误会直接传递到装配动作。验证方法有三种：一是“回原点验证”，将机器人移动到工件坐标系原点，观察工具尖端是否对准工件基准点，偏差应小于0.5 mm；二是“沿轴验证”，在工件坐标系下沿X轴移动100 mm，用直尺或激光测距确认实际移动方向与距离一致；三是“装配试跑”，用低速（如50 mm/s）执行一次抓取—插入动作，观察插入是否顺畅、有无侧向刮擦。

若验证发现偏差，优先检查TCP残差和工件坐标系三点是否共线或过于接近。三点法要求三点不共线且间距大于50 mm，否则解算不稳定。此外，UR的“工具中心点”和“工件坐标系”在示教器上都有激活状态，编程时务必确认当前激活的是哪一个，避免“用错坐标系”导致碰撞。

掌握这三个坐标系的定义、标定与验证，是UR柔性装配单元从“能动”走向“能装”的关键一步。后续的路径规划、力控插入和拧紧策略，都建立在这套坐标关系准确可靠的基础之上。