机械臂基础：硬件组成、运动学与坐标系标定

视觉引导拣选系统的核心执行单元是机械臂，其硬件结构、运动学模型与坐标系标定质量，直接决定了“看见”与“抓取”之间的转化精度。本章从工程实践视角出发，系统拆解机械臂的硬件组成与关节驱动链路，深入讲解正逆运动学的基本原理与求解思路，并重点阐述工具坐标系（TCP）与用户坐标系的标定流程。理解这些基础，是后续开发视觉标定、手眼标定与抓取规划的前提。

2.1 机械臂硬件组成与驱动链路

2.1.1 核心原理：从关节到末端执行器的机电协同

六轴串联机械臂是视觉引导拣选最常用的构型，其硬件可划分为结构本体、驱动传动、感知反馈、控制通信与末端执行五个层次。结构本体包括基座、腰部、大臂、小臂及腕部（通常由三个旋转轴构成Roll、Pitch、Yaw），各关节通过伺服电机配合谐波减速器或RV减速器实现大扭矩、低背隙的动力输出。每个关节均集成增量式或值编码器，用于实时反馈关节角度；抱闸装置确保断电时机械臂不会因重力坠落。驱动器接收控制器的位置指令，通过电流环、速度环、位置环三环PID完成高精度伺服控制。末端法兰盘用于安装夹爪、吸盘或快换盘，是连接视觉系统与执行动作的物理接口。

在视觉引导拣选场景中，硬件选型需重点关注三个参数：重复定位精度（决定抓取一致性）、最大运动速度（影响节拍）、末端最大负载（需覆盖夹爪+工件重量）。例如，在3C电子装配中，常选用负载3-6kg、重复精度±0.02mm的协作机械臂；而在物流拆垛场景，则需负载10-20kg、臂展1.5m以上的工业机械臂。

2.1.2 判断方法：硬件状态评估与选型核对清单

开发视觉引导系统前，必须对机械臂硬件进行状态确认，避免后续调试中因硬件问题导致视觉定位失效。建议按以下流程逐项检查：

1. 关节运动范围测试：手动示教模式下，逐一运动各轴至正负极限，确认无机械干涉、无异响、无抖动。
2. 抱闸功能验证：在关节悬停状态下断电，确认抱闸能可靠锁止，溜车量不超过0.5°。
3. 编码器零位校准：检查各关节编码器零位与机械零位是否一致，若偏差超过0.1°需重新标定。
4. 末端法兰跳动量测量：使用千分表测量法兰端面及外圆跳动，要求端面跳动≤0.03mm，径向跳动≤0.02mm。
5. 通信延迟测试：通过EtherCAT或Profinet总线发送位置指令，测量从指令发出到驱动器响应的往返延迟，应小于2ms。

2.1.3 案例拆解：六轴机械臂在视觉拣选中的硬件配置

以某汽车零部件工厂的螺栓分拣工位为例，该工位需从料筐中抓取M8×30mm螺栓并放置到装配托盘。初始方案选用某品牌6轴工业机械臂，负载6kg，重复精度±0.03mm，臂展1.2m。实际调试中发现以下问题：

• 螺栓在料筐中姿态随机，需视觉系统输出6D位姿（X/Y/Z/Rx/Ry/Rz），但机械臂腕部第5轴（Pitch）运动范围仅±120°，导致部分姿态无法到达。
• 夹爪采用二指平行气爪，重量0.8kg，加上视觉相机0.3kg，末端总负载1.1kg，接近机械臂额定负载的18%，动态性能下降。

针对上述问题，采取以下优化措施：

1. 将视觉系统输出的姿态约束在机械臂可达空间内，通过预抓取点规划避开腕部极限。
2. 更换碳纤维材质夹爪，重量降至0.4kg，末端总负载降至0.7kg。
3. 在机械臂控制器中开启“高动态模式”，将加速度从默认的1.5m/s²提升至2.5m/s²，节拍从12s/件缩短至8s/件。

最终系统稳定运行，抓取成功率从初期的92%提升至99.5%，单件节拍满足生产要求。该案例说明，硬件选型不仅要看参数表，还需结合视觉系统重量、工件姿态分布和节拍要求进行综合校核。

2.1.4 常见误区与总结复盘

• 误区一：只关注重复定位精度，忽略定位精度。视觉引导依赖机械臂将视觉坐标转换为实际运动，定位精度（通常为±0.1~0.3mm）比重复精度更关键。若精度不足，需通过标定补偿或视觉伺服闭环修正。
• 误区二：忽视末端负载对动态性能的影响。负载增加会降低机械臂的固有频率，导致高速运动时末端振动加剧，影响视觉抓取稳定性。建议末端负载不超过额定负载的30%。
• 误区三：未考虑线缆管理。视觉相机、夹爪传感器、气动管路等线缆若未合理固定，会随机械臂运动产生拉扯，导致信号干扰或接头松动。应使用拖链或弹簧线缆，并预留足够长度。

2.2 运动学基础：正解与逆解

2.2.1 核心原理：D-H建模与位姿描述

机械臂运动学描述的是关节空间与笛卡尔空间之间的映射关系。采用Denavit-Hartenberg（D-H）参数法，对每个连杆建立4个参数：连杆长度a_i-1、连杆扭转角α_i-1、关节距离d_i、关节角θ_i。通过齐次变换矩阵的连乘，可得到末端执行器相对于基坐标系的位姿矩阵：

T_06 = T_01 × T_12 × T_23 × T_34 × T_45 × T_56

其中T_06为4×4齐次矩阵，包含旋转矩阵R（3×3）和平移向量P（3×1）。正运动学即已知6个关节角θ₁~θ₆，求解末端位姿；逆运动学则相反，已知末端目标位姿，求解满足条件的关节角组合。六轴机械臂的逆解通常存在多组解（最多8组），需根据关节限位、避障和运动连续性选择最优解。

2.2.2 判断方法：逆解求解策略与奇异位形规避

实际工程中，逆解求解需遵循以下步骤：

1. 位姿分解：将目标位姿矩阵拆分为位置向量和姿态矩阵，先求解腕部中心位置（P_wrist = P_end - d₆·R·[0,0,1]^T）。
2. 前三个关节求解：根据P_wrist求解θ₁、θ₂、θ₃，通常采用几何法或解析法。
3. 后三个关节求解：由姿态矩阵R和已求得的θ₁~θ₃，求解腕部欧拉角对应的θ₄、θ₅、θ₆。
4. 多解筛选：遍历所有候选解，剔除超出关节限位的组合，再根据“最短行程”或“最小能量”原则选择最优解。

奇异位形是逆解求解的难点，常见于以下情况：

• 腕部奇异：当θ₅=0°时，第4轴与第6轴轴线重合，丢失一个旋转自由度。
• 肩部奇异：当腕部中心位于第1轴轴线上时，θ₁无法唯一确定。
• 肘部奇异：当大臂与小臂完全伸直时，第3轴达到极限位置。

2.2.3 案例拆解：视觉引导下的逆解选择与轨迹平滑

在某食品包装线的视觉拣选工位，机械臂需从传送带上抓取随机摆放的饼干盒。视觉系统输出目标位姿为：位置(350.2, -120.5, 85.0)mm，姿态欧拉角(180°, 0°, 45°)。控制器逆解得到4组可行解：

对比上一抓取点的关节位置（θ_prev = [10°, -40°, 115°, 25°, 80°, 15°]），解1的行程总和最小且各关节变化平缓，因此被选中。执行过程中，控制器在关节空间进行五次多项式插值，确保速度、加速度连续。该策略使抓取节拍稳定在6.5s/件，且未出现奇异位形导致的抖动。

2.2.4 常见误区与总结复盘

• 误区一：直接使用数值迭代法求解逆解。数值法（如牛顿-拉夫逊）虽然通用，但计算量大、可能收敛到局部解，且无法保证实时性。工业应用中应优先采用解析法，仅在解析法不可用时才考虑数值法。
• 误区二：忽略多解切换时的连续性。当目标位姿连续变化时，若逆解选择策略不当，可能导致关节角跳变，造成机械臂急停或轨迹偏离。应建立“上一解记忆”机制，优先选择与上一时刻关节角最接近的解。
• 误区三：未考虑基坐标系与视觉坐标系的转换。视觉系统输出的坐标通常基于相机坐标系，需先通过手眼标定矩阵转换到机械臂基坐标系，再进行逆解。若跳过此步骤，逆解结果将完全错误。

2.3 常用坐标系与工具坐标系标定

2.3.1 核心原理：坐标系定义与变换链

视觉引导拣选涉及多个坐标系的转换，主要包括：

• 世界坐标系（W）：固定于工作空间的参考系，通常与机械臂基座重合或定义在流水线某固定点。
• 基坐标系（B）：固连于机械臂底座，是机械臂运动学的参考原点。
• 工具坐标系（T）：固连于末端执行器（如夹爪中心或吸盘中心），描述工具的有效工作点（TCP）。
• 用户坐标系（U）：用户自定义的工作平面坐标系，便于编程和视觉坐标映射。
• 相机坐标系（C）：视觉传感器成像的参考系，分为固定相机（Eye-to-Hand）和手眼相机（Eye-in-Hand）两种安装方式。

完整的坐标变换链为：像素坐标 → 相机坐标 → 工具坐标 → 基坐标 → 世界坐标。其中，工具坐标系的标定精度直接影响抓取位置准确性，是视觉引导系统中最关键的标定环节。

2.3.2 操作流程：TCP四点法与六点法标定

四点法（TCP位置标定）是最常用的工具坐标系位置标定方法，操作步骤如下：

1. 在机械臂工作空间内固定一个尖锐参考点（如锥形针尖）。
2. 手动示教机械臂，使工具尖端（TCP）以四种不同姿态对准参考点，记录四组关节角。
3. 控制器根据四组关节角对应的末端法兰位姿，通过最小二乘法求解TCP在法兰坐标系中的位置偏移（X_tcp, Y_tcp, Z_tcp）。
4. 验证：将TCP移动到参考点上方，以不同姿态接近，确认尖端始终对准同一点。

六点法（TCP位置+姿态标定）在四点法基础上增加两个姿态参考点，用于确定工具坐标系的X轴和Z轴方向。具体为：

1. 完成四点法位置标定。
2. 示教工具尖端沿工具X轴正方向移动一段距离，记录该方向向量。
3. 示教工具尖端沿工具Z轴正方向移动一段距离，记录该方向向量。
4. 控制器通过向量正交化计算完整的旋转矩阵R_tcp。

2.3.3 案例拆解：视觉引导抓取中的坐标系标定实战

在某3C电子装配线，机械臂需抓取电路板上的连接器并插入对应插座。视觉系统采用Eye-in-Hand安装方式（相机固定在机械臂末端），系统包含以下坐标系：

• 基坐标系B：位于机械臂底座中心。
• 工具坐标系T：定义在夹爪两指中心，Z轴指向抓取方向。
• 相机坐标系C：位于相机光心，Z轴沿光轴方向。

标定流程如下：

1. 手眼标定：使用棋盘格标定板，机械臂运动到15个不同位姿拍摄标定板，通过Tsai-Lenz算法求解相机坐标系到工具坐标系的变换矩阵X（4×4）。重投影误差控制在0.2像素以内。
2. TCP标定：采用六点法，将夹爪尖端对准固定锥尖，记录6组姿态，求解TCP在法兰坐标系中的位置和姿态。
3. 用户坐标系标定：在电路板放置平面定义用户坐标系U，通过三点法（原点、X轴点、Y轴点）建立。
4. 坐标变换验证：将已知位置的校准销钉放置在电路板指定孔位，视觉识别后计算坐标，与机械臂实际运动到该点的位置对比，误差应小于0.3mm。

实际运行中，视觉系统输出连接器在相机坐标系下的位姿，通过手眼矩阵X和工具矩阵T转换到基坐标系，再结合用户坐标系进行抓取。该系统连续运行72小时，抓取成功率99.2%，定位误差稳定在±0.15mm以内。

2.3.4 常见误区与总结复盘

• 误区一：TCP标定后不进行验证。标定结果受示教精度影响，若操作者手动示教时存在偏差，TCP误差可能达到1-2mm。必须通过自动验证程序（如多点验证）确认精度。
• 误区二：忽略温度对机械臂的影响。机械臂长时间运行后，关节热膨胀会导致TCP漂移。建议在开机预热30分钟后进行标定，并在连续运行4小时后重新验证。
• 误区三：手眼标定与TCP标定顺序颠倒。应先标定TCP，再进行手眼标定。因为手眼标定需要机械臂末端位姿作为输入，而末端位姿依赖于准确的工具坐标系。