运动学基础：正运动学与逆运动学，雅可比矩阵，奇异点分析，多轴联动的基本概念

多轴插补算法的本质，是在关节空间与笛卡尔空间之间建立精确的映射关系，并在此映射之上规划出平滑、连续、可控的运动轨迹。无论是三轴雕刻机、五轴联动加工中心，还是六轴工业机器人，其运动控制核心都离不开运动学模型的支撑。本章将系统梳理正运动学与逆运动学的数学框架、雅可比矩阵的速度与力映射作用、奇异点的物理意义与规避策略，以及多轴联动中“联动”二字的真正内涵。理解这些基础概念，是后续编写插补器、实现前瞻控制与误差补偿的前提。

正运动学：从关节坐标到末端位姿的确定性映射

正运动学解决的是“给定各关节角度或位移，求末端执行器的位置与姿态”的问题。对于串联机构，通常采用 Denavit-Hartenberg（D-H）参数法建立相邻连杆坐标系的齐次变换矩阵。每个关节的变换矩阵由四个参数决定：连杆长度 a_i-1、连杆扭转角 α_i-1、关节距离 d_i 和关节角 θ_i。将 n 个关节的变换矩阵依次相乘，即可得到末端坐标系相对于基坐标系的位姿矩阵：

T_0n = A_1 · A_2 · A_3 · … · A_n

其中每个 A_i 是一个 4×4 齐次矩阵，包含旋转分量 R（3×3）和平移分量 P（3×1）。正运动学的计算是唯一且确定的——给定一组关节变量，末端位姿必然唯一。这一特性使得正运动学常用于仿真验证、视觉标定和离线编程中的轨迹预览。

逆运动学：多解性与求解策略

逆运动学是正运动学的反问题：已知末端期望位姿，求解满足条件的关节变量。与正解不同，逆解存在三个显著特征：多解性（同一末端位姿可能对应多组关节角）、奇异性（某些位姿下无解或解不连续）、非线性（超越方程难以直接求闭式解）。

求解方法分为两大类：

• 解析法（闭式解）：通过代数消元或几何投影将运动学方程化简为多项式方程。典型如六轴机器人满足 Pieper 准则（后三个关节轴交于一点）时，可分解为位置逆解和姿态逆解。解析法速度快、精度高，适合实时控制。
• 数值法（迭代法）：如牛顿-拉夫森法、雅可比迭代法。通过不断修正关节角使末端误差收敛。数值法通用性强，但计算量大、可能陷入局部极小值，且无法保证实时性。

在实际多轴插补系统中，逆解通常在每个插补周期内被调用。例如五轴数控机床的刀尖点控制（RTCP）功能，需要实时将刀尖点的笛卡尔坐标转换为旋转工作台和直线轴的位置指令。此时必须选择与当前关节角最接近的一组解，以避免关节突变。

雅可比矩阵：速度与力的桥梁

雅可比矩阵 J(θ) 是关节速度与末端笛卡尔速度之间的线性映射关系：

v = J(θ) · θ̇

其中 v 是末端线速度和角速度组成的 6 维向量，θ̇ 是 n 个关节的速度向量。雅可比矩阵的每一列对应一个关节运动对末端速度的贡献。对于 n 关节机器人，J 是 6×n 矩阵。当 n=6 且 J 可逆时，可以通过逆雅可比将期望的笛卡尔速度映射为关节速度：

θ̇ = J⁻¹ · v

雅可比矩阵的转置还揭示了力映射关系：关节力矩 τ 与末端力 F 满足 τ = Jᵀ · F。这一关系在力控、阻抗控制和碰撞检测中至关重要。例如，当末端执行器与工件接触产生反作用力时，可以通过 Jᵀ 估算各关节需要承受的力矩，从而判断是否超出驱动器额定负载。

奇异点分析：自由度退化的临界状态

当雅可比矩阵的行列式为零（det(J)=0）时，机构处于奇异位形。此时矩阵不可逆，逆雅可比不存在，导致两个严重后果：

1. 速度反解失效：某些方向的笛卡尔速度无法通过关节速度合成，末端在这些方向上失去运动能力。
2. 关节速度趋于无穷：若强行要求末端沿奇异方向运动，关节速度将急剧增大，超出驱动器能力，引发振动或飞车。

奇异点分为两类：

• 边界奇异：发生在工作空间边界，如机械臂完全伸直或完全折叠时。此时机构无法继续向外运动。
• 内部奇异：发生在工作空间内部，通常由两个或多个关节轴线重合导致。例如六轴机器人的第 4 轴和第 6 轴共线时，末端姿态自由度退化。

奇异点的检测方法包括：计算 det(J) 的值并与阈值比较；或使用条件数 cond(J) = ||J|| · ||J⁻¹|| 评估病态程度。条件数越大，说明矩阵越接近奇异，数值稳定性越差。

多轴联动的基本概念：同步、插补与轮廓精度

多轴联动并非简单的“多个轴同时运动”，而是指各轴按照插补算法生成的指令，在时间上严格同步地协调运动，使末端执行器沿期望的笛卡尔轨迹运动。其核心要素包括：

• 插补周期同步：所有伺服轴的指令更新必须发生在同一时间基准上。通常由硬件定时器产生同步中断，确保各轴在同一时刻执行新的位置指令。
• 轨迹插补：将目标轨迹（直线、圆弧、样条）离散为一系列插补点，每个插补点对应一组关节角或末端位姿。插补点的密度由进给速度和插补周期决定。
• 轮廓误差控制：实际轨迹与理论轨迹之间的偏差称为轮廓误差。多轴联动时，各轴跟踪误差的耦合会导致轮廓误差放大。例如，在圆弧插补中，X 轴和 Y 轴的跟踪误差方向不同，可能使实际轨迹变成椭圆。

以典型的三轴直线插补为例，假设起点 P0(0,0,0)，终点 P1(30,40,50)，进给速度 F=100mm/s，插补周期 T=1ms。则每个周期的位移增量为 0.1mm，总插补步数 N=√(30²+40²+50²)/0.1 ≈ 707 步。每步各轴增量分别为 Δx=30/707≈0.0424mm，Δy=40/707≈0.0566mm，Δz=50/707≈0.0707mm。控制器将这些增量转换为各轴的位置指令，并同步输出到伺服驱动器。

常见误区与总结复盘

在运动学基础的学习与工程应用中，以下误区值得特别注意：