3. 机械臂运动学基础

机械臂运动学是机器人学的基石,它研究的是机械臂在空间中的运动几何关系,而不涉及产生运动所需的力和力矩。本章将深入剖析运动学中的核心概念:关节空间与笛卡尔空间的映射关系、自由度的本质、工作空间的形态与边界,以及奇异位形这一关键瓶颈。理解这些概念是后续进行轨迹规划、路径规划与运动控制的前提。无论是设计一个简单的SCARA机器人,还是复杂的七自由度冗余机械臂,这些基础概念都决定了系统的能力上限与潜在风险。

机械臂运动学核心概念关系图 关节空间 (Joint Space) q = [q1, q2, ..., qn]ᵀ n个关节角度/位移 维度 = 自由度n 控制指令直接作用域 笛卡尔空间 (Cartesian Space) x = [x, y, z, α, β, γ]ᵀ 位置 + 姿态 (6维) 任务规划自然空间 视觉/力觉反馈空间 正运动学 (FK) 唯一映射: q → x 逆运动学 (IK) 多解/无解/奇异 自由度 (DOF) 独立运动变量数目 6DOF → 可达空间任意位姿 7DOF → 冗余/避障 <6DOF → 任务受限 工作空间 (Workspace) 末端可达位置集合 可达空间 vs 灵活空间 受关节限位/连杆长度影响 内部空洞/边界不可达 奇异位形 (Singularity) 雅可比矩阵降秩 关节速度→∞ 末端自由度丢失 边界奇异/内部奇异 核心关系:关节空间通过正/逆运动学与笛卡尔空间相互映射,自由度决定映射维度,工作空间定义可达范围,奇异位形是映射失效的临界点

上图清晰地展示了本章四个核心概念之间的内在逻辑关系。关节空间是控制指令的直接作用域,而笛卡尔空间是任务规划的自然表达域,两者通过正运动学(FK)和逆运动学(IK)相互联系。自由度决定了关节空间的维度,工作空间是笛卡尔空间中末端执行器可达区域的集合,而奇异位形则是运动学映射中雅可比矩阵降秩的临界状态。下面我们将逐一深入剖析这些概念。

3.1 关节空间与笛卡尔空间:运动学的双重视角

3.1.1 核心原理:两种空间的本质与映射

关节空间(Joint Space)是以机械臂各关节变量(旋转关节的角度或移动关节的位移)为坐标轴构成的多维空间。对于一个具有n个关节的机械臂,其关节空间是n维的,任意一点q = [q₁, q₂, ..., qₙ]ᵀ唯一确定机械臂的一个位形。关节空间是伺服控制器的直接作用域——电机接收的指令就是关节位置、速度和力矩。

笛卡尔空间(Cartesian Space),又称任务空间或操作空间,是以末端执行器在三维空间中的位置(x, y, z)和姿态(α, β, γ,通常用欧拉角、旋转矩阵或四元数表示)为坐标构成的空间。笛卡尔空间是任务规划的自然表达域——工程师在设计“从A点抓取物体移动到B点”时,直观地使用笛卡尔坐标描述目标位置。

两个空间之间的映射关系由机械臂的几何参数(连杆长度、偏置、扭转角)决定。正运动学(Forward Kinematics, FK)是从关节空间到笛卡尔空间的映射,即已知各关节角度,求解末端位姿。逆运动学(Inverse Kinematics, IK)则相反,已知末端期望位姿,求解满足条件的关节角度组合。

特性关节空间笛卡尔空间
坐标变量关节角度/位移 qᵢ位置+姿态 (x,y,z,α,β,γ)
维度等于关节数n通常为6(位置3+姿态3)
映射关系FK: 唯一确定IK: 多解/无解/奇异
控制层级伺服层(电机指令)规划层(任务描述)
直观性不直观,需几何想象直观,符合人类认知
轨迹插补简单,无奇异问题需实时IK,可能遇奇异

3.1.2 判断方法:何时使用哪种空间

在实际工程中,选择在哪个空间进行轨迹规划取决于任务需求:

  • 关节空间规划:适用于点到点运动(PTP),如从初始位形运动到目标位形,中间路径无严格约束。优点是计算简单、不会产生奇异问题,缺点是末端路径不可预测,可能超出工作空间边界。
  • 笛卡尔空间规划:适用于连续路径任务,如焊接、涂胶、切割等需要末端沿特定直线或曲线运动的场景。优点是路径可控,缺点是计算量大,且可能遇到IK无解或奇异位形。
工程经验:在工业机器人编程中,PTP指令(关节空间)用于快速转移,LIN指令(笛卡尔空间)用于工艺路径。混合使用可兼顾效率与精度。例如,焊接机器人先用PTP快速接近工件,再用LIN沿焊缝精确运动。

3.1.3 案例拆解:六轴机器人直线轨迹的IK求解

以典型的六自由度串联机械臂(如ABB IRB 120)为例,要求在笛卡尔空间从点A(0.3, 0.2, 0.4)直线运动到点B(0.5, 0.1, 0.3),姿态保持不变(欧拉角ZYX: 0°, 30°, 0°)。

初始条件:机械臂DH参数已知,关节限位为±170°。在A点,通过FK得到关节角q_A = [0°, 45°, -30°, 0°, 60°, 0°]ᵀ。

分析过程:

  1. 在笛卡尔空间将AB线段离散为N=100个插补点,每个点包含位置和姿态。
  2. 对每个插补点调用IK求解器(解析法或数值法),得到关节角q_i。
  3. 检查每个q_i是否在关节限位内,且关节速度不超过额定值。

关键数据:在插补点第50个(中点)处,IK求解得到两组解:q₁ = [5°, 30°, -20°, 10°, 50°, 5°]ᵀ 和 q₂ = [5°, 150°, 20°, -170°, -50°, 175°]ᵀ。q₂中关节2和关节4接近限位,且关节速度变化剧烈,应选择q₁。

结果与复盘:选择q₁后,实际末端轨迹与理想直线偏差小于0.1mm,满足焊接精度要求。若不加选择地使用q₂,关节4会触发限位报警,导致运动中断。因此,在笛卡尔空间规划时,必须对IK多解进行最优选择,通常以“关节位移最小”或“关节速度最小”为准则。

3.1.4 常见误区与总结

误区1:认为IK一定有解。实际上,当目标点超出工作空间时,IK无解;当目标点位于奇异位形附近时,IK解可能退化。
误区2:在关节空间规划时忽略末端路径。PTP运动虽然关节轨迹平滑,但末端可能走出大圆弧甚至穿过工作空间边界,这在狭小空间作业时是致命的。
误区3:混淆“可达空间”与“灵活空间”。可达空间是末端至少能以某种姿态到达的区域,而灵活空间是末端能以任意姿态到达的区域。后者通常远小于前者。

总结:关节空间与笛卡尔空间是运动学的双重视角,正运动学提供唯一映射,逆运动学则面临多解、无解和奇异三大挑战。工程中应根据任务需求选择规划空间,并对IK解进行合理筛选。

3.2 自由度:机械臂的运动能力度量

3.2.1 核心原理:自由度的定义与意义

自由度(Degrees of Freedom, DOF)是描述机械臂运动独立变量的最小数目。在三维空间中,一个刚体具有6个自由度:3个平动(沿x、y、z轴移动)和3个转动(绕x、y、z轴旋转)。机械臂的自由度等于其关节数(假设每个关节提供1个自由度,且无冗余约束)。

对于串联机械臂,自由度n决定了其末端执行器在笛卡尔空间中的运动能力:

  • n = 6:末端可在工作空间内到达任意位置和姿态(非奇异时),满足大多数工业任务。
  • n < 6:末端运动受限。例如,SCARA机器人(4DOF)只能实现平面内定位和绕垂直轴旋转,无法改变末端俯仰和翻滚姿态。
  • n > 6:冗余自由度。例如,7DOF机械臂(如KUKA iiwa)在保持末端位姿不变的情况下,肘部可绕肩-腕连线旋转,实现避障和优化关节力矩。

3.2.2 判断方法:如何确定所需自由度

确定机械臂自由度需考虑任务需求、成本与复杂度:

  1. 任务需求分析:列出任务所需的末端运动能力。例如,搬运任务需要3个平动+1个转动(绕重力方向),4DOF足够;而复杂装配需要6DOF。
  2. 工作空间形状:若任务空间是狭长通道,可能需要冗余自由度来调整臂型。
  3. 成本与可靠性:每增加1个自由度,机械臂的成本、重量、控制复杂度显著增加。工业中“够用就好”是原则。
典型应用对照:
机械臂类型DOF典型应用运动能力
直角坐标机器人3点胶、搬运仅平动,无姿态变化
SCARA4贴片、装配平面定位+垂直轴旋转
六轴关节机器人6焊接、喷涂、打磨全位姿可达
七轴协作机器人7人机协作、复杂装配冗余避障、柔顺控制

3.2.3 案例拆解:7DOF冗余机械臂的避障优势

以KUKA LBR iiwa 14 R820为例,其7个旋转关节提供了冗余自由度。在汽车发动机舱内进行螺栓拧紧任务时,末端需要以特定姿态到达螺栓位置,同时机械臂本体不能与舱内管路干涉。

初始条件:末端目标位姿固定(位置和姿态均确定),但肘部位置可在以肩-腕连线为轴的一个圆上自由移动(称为“肘圆”)。

分析过程:

  1. 使用解析IK求解6DOF解,得到肘部位置的两个候选点(肘上/肘下)。
  2. 利用冗余自由度,将肘部位置参数化为肘圆上的角度φ。
  3. 在φ ∈ [0, 2π]范围内搜索,找到使机械臂连杆与障碍物距离最大的φ值。

关键数据:初始φ=0°时,连杆3与管路最小距离为15mm,存在碰撞风险。通过优化,φ=120°时,最小距离增大到85mm,安全裕度显著提升。

结果与复盘:冗余自由度不仅解决了避障问题,还通过优化关节力矩分布降低了能耗。但代价是控制算法复杂度增加,需要实时求解冗余解析。若使用6DOF机械臂,则只能通过调整末端姿态来避障,可能无法满足工艺要求。

3.2.4 常见误区与总结

误区1:认为DOF越多越好。冗余自由度带来灵活性的同时,也带来刚度下降、控制难度增加、成本上升等问题。
误区2:忽略“有效自由度”。某些关节在特定位形下可能退化(如两个相邻关节轴线平行时),导致实际有效自由度小于名义值。
误区3:混淆自由度与工作空间大小。DOF决定运动能力维度,而工作空间大小由连杆长度和关节限位决定,两者无直接关系。

总结:自由度是机械臂运动能力的度量,6DOF是大多数工业任务的门槛,7DOF提供冗余灵活性,而少于6DOF则需接受任务限制。选型时应基于任务需求、成本与可靠性综合权衡。

3.3 工作空间:可达区域的边界与内部结构

3.3.1 核心原理:工作空间的定义与分类

工作空间(Workspace)是机械臂末端执行器在笛卡尔空间中所有可达位置的集合。根据姿态约束的不同,可分为:

  • 可达工作空间(Reachable Workspace):末端至少能以某种姿态到达的所有位置集合。这是最宽松的定义。
  • 灵活工作空间(Dexterous Workspace):末端能以任意姿态到达的所有位置集合。这是最严格的定义,通常远小于可达空间。

工作空间的形状和大小由以下因素决定:

  • 连杆长度:连杆越长,工作空间越大,但刚度和精度下降。
  • 关节限位:限位越宽,工作空间越大,但可能引入奇异位形。
  • 关节类型:旋转关节产生环形工作空间,移动关节产生矩形工作空间。
  • 基座位置:基座安装位置决定工作空间在环境中的布局。

3.3.2 判断方法:如何评估工作空间是否满足任务

在机械臂选型和任务规划中,工作空间评估是关键步骤:

  1. 任务点分布:将任务中所有目标点(如焊点、装配孔位)标注在笛卡尔空间中,检查是否全部落在可达工作空间内。
  2. 姿态可达性:对于每个目标点,检查是否在灵活工作空间内。若仅需特定姿态,则检查该姿态是否可达。
  3. 边界裕度:目标点应远离工作空间边界,因为边界附近运动学性能差(接近奇异),且控制精度下降。
工程经验:使用机器人厂商提供的仿真软件(如RobotStudio、RoboDK)导入CAD模型,自动生成工作空间云图。通常要求目标点距离边界至少50mm,以保证运动平稳性和精度。

3.3.3 案例拆解:焊接工位的工作空间验证

某汽车零部件焊接工位,使用FANUC M-710iC/50六轴机器人,需焊接12个焊点,分布在工件两侧。

初始条件:工件尺寸为800mm×600mm×400mm,焊点坐标已通过CAD提取。机器人基座安装在地面,距工件中心500mm。

分析过程:

  1. 在仿真软件中导入机器人模型和工件模型,设置基座位置。
  2. 运行工作空间分析模块,生成可达空间云图。
  3. 将12个焊点坐标映射到云图中,检查可达性。

关键数据:12个焊点中,10个在可达空间内,2个在边界附近(距边界约30mm)。进一步检查姿态,发现这2个焊点需要末端以较大俯仰角(>60°)接近,导致IK解接近奇异。

操作步骤:

  • 调整机器人基座位置,向工件方向移动100mm。
  • 重新生成工作空间云图,12个焊点全部进入可达空间,且距边界均大于80mm。
  • 验证所有焊点的姿态可达性,IK求解成功,关节角均在限位内。

结果与复盘:通过调整基座位置,解决了工作空间边界问题。若无法移动基座,则需考虑更换更大工作空间的机器人型号,或改变工件装夹方向。此案例说明,工作空间验证必须在选型阶段完成,否则后期改造代价巨大。

3.3.4 常见误区与总结

误区1:只关注可达空间,忽略灵活空间。很多任务需要特定姿态,若目标点不在灵活空间内,则实际不可达。
误区2:忽略工作空间内部的“空洞”。某些机械臂(如肘部奇异)在工作空间内部存在不可达区域,形成空洞。
误区3:认为工作空间是静态的。实际上,负载变化、工具长度变化都会改变有效工作空间。

总结:工作空间是机械臂能力的空间边界,评估时必须同时考虑可达性和姿态灵活性。仿真验证是选型和工位设计不可或缺的环节。

3.4 奇异位形:运动学映射的临界点

3.4.1 核心原理:奇异位形的数学本质

奇异位形(Singularity)是机械臂在特定位形下,雅可比矩阵J(q)降秩(即行列式为零)的状态。雅可比矩阵将关节速度映射到末端速度:

v = J(q) · q̇

其中v是末端速度向量(线速度+角速度),q̇是关节速度向量。当J降秩时,末端在某些方向上的运动能力丧失,即使关节速度趋于无穷大,末端也无法产生该方向的速度。

奇异位形分为两类:

  • 边界奇异(Boundary Singularity):发生在工作空间边界,此时机械臂完全伸展或折叠,末端无法向边界外运动。
  • 内部奇异(Interior Singularity):发生在工作空间内部,通常由两个或多个关节轴线共线或平行引起。例如,六轴机器人的腕部奇异(关节4和关节6轴线共线)和肘部奇异(关节1和关节6轴线共线)。

3.4.2 判断方法:如何检测和避免奇异

奇异检测是运动控制中的关键环节:

  1. 雅可比矩阵条件数:计算J(q)的条件数κ = ||J|| · ||J⁻¹||。条件数越大,接近奇异;当κ → ∞时,处于奇异位形。
  2. 可操作度(Manipulability):定义w = √(det(J·Jᵀ))。w = 0时处于奇异,w越小越接近奇异。
  3. 关节速度监控:若某关节速度指令超过额定值数倍,且末端速度很小,则可能接近奇异。
奇异避免策略:
策略原理适用场景
奇异回避路径规划在规划阶段避开奇异区域离线编程
阻尼最小二乘法(DLS)在IK求解中加入阻尼项,牺牲精度换取稳定性实时控制
奇异分离将运动分解为奇异方向和正常方向,分别处理高精度任务
冗余自由度利用7DOF机械臂通过调整臂型避开奇异协作机器人

3.4.3 案例拆解:六轴机器人腕部奇异处理

某喷涂机器人(6DOF)在喷涂汽车车门内板时,末端需经过一条接近垂直的路径,导致腕部关节(关节4和关节6)轴线趋于共线,进入腕部奇异。

初始现象:在路径中点附近,关节4和关节6的速度指令急剧增大,超过额定值300%,而末端速度正常。控制器触发“关节速度超限”报警,运动中断。

分析过程:

  1. 检查该位形的雅可比矩阵,计算可操作度w = 0.02(远小于正常值1.0),确认处于奇异附近。
  2. 分析原因:末端路径方向与奇异方向(关节4/6共线方向)接近平行,导致该方向速度需要极大关节速度来补偿。

操作步骤:

  • 在路径规划中,将奇异区域标记为“禁区”,在接近奇异前切换为关节空间插补。
  • 使用DLS方法进行IK求解,设置阻尼因子λ = 0.01,允许末端轨迹偏差0.5mm。
  • 在奇异区域,降低末端速度至原来的50%,减小关节速度峰值。

结果对比:

方案关节4最大速度末端轨迹偏差运动是否中断
原始方案320%额定0mm是
DLS方案85%额定0.4mm否
降速+DLS60%额定0.3mm否

复盘经验:奇异无法完全避免,但可以通过合理规划和控制策略将其影响降至最低。喷涂工艺允许0.5mm偏差,因此DLS方案可行;若为精密装配(偏差要求<0.1mm),则必须重新规划路径,完全避开奇异区域。

3.4.4 常见误区与总结

误区1:认为奇异只发生在工作空间边界。实际上,内部奇异(如腕部奇异)更常见且更危险,因为它在工作空间内部突然出现。
误区2:忽略奇异对控制精度的影响。即使未触发报警,接近奇异时关节速度也会急剧增大,导致跟踪误差增大和机械振动。
误区3:认为增加自由度就能完全消除奇异。7DOF机械臂可以避开大部分奇异,但仍有残余奇异(如肩部奇异),只是概率降低。

总结:奇异位形是运动学映射的固有属性,无法消除但可以管理。通过雅可比条件数监控、DLS求解和路径规划回避,可以将奇异风险控制在可接受范围内。