4. 多轴关节控制基础

多轴关节控制是机器人运动控制的核心。无论是六轴工业机械臂、协作机器人，还是人形机器人的四肢，其控制问题最终都归结为：如何让多个关节在实时约束下协同运动，使末端执行器或机身达到期望的位置、姿态与动态性能。本章从关节类型出发，逐步建立运动学、动力学与多轴协调控制的概念框架，并梳理常见机器人构型，为后续实时Linux下的控制实现打下基础。

一、关节类型：旋转、移动与柔性

关节是连接相邻连杆的运动副，决定了机器人自由度的性质。工程中最常见的是旋转关节（Revolute, R），其运动变量为角度 θ，输出力矩 τ；其次是移动关节（Prismatic, P），运动变量为位移 d，输出力 F。二者组合可构成 RRR、RPR 等不同运动链。此外，按驱动与传动方式还可区分：

• 刚性关节：谐波减速器、RV减速器直接驱动，刚度高、响应快，但冲击大。
• 柔性关节：串联弹性驱动器（SEA），引入弹性元件，具备力控与缓冲能力，但带宽受限。
• 准直驱关节：低减速比+力矩电机，兼顾力控与动态性能，常见于四足与协作机器人。

关节类型直接决定控制器的设计：刚性关节以位置/速度环为主，柔性关节需引入弹性力矩观测与补偿，准直驱关节则强调电流环带宽与力矩前馈。

二、运动学基础：从关节空间到笛卡尔空间

运动学描述关节变量 q 与末端位姿 x 之间的几何映射关系。正运动学由 DH 参数或旋量法建立，形式为 x = f(q)；逆运动学则求解 q = f⁻¹(x)，通常存在多解、奇异与无解问题。对于多轴系统，雅可比矩阵 J(q) 是核心工具，它建立关节速度与末端速度的线性关系：ẋ = J(q)·q̇。

雅可比矩阵的秩决定了系统的可操作度。当 J 降秩时，机器人进入奇异位形，某些方向无法运动，逆解发散。实时控制中必须监测可操作度指标，并在接近奇异时采取阻尼最小二乘或任务优先级策略。

# 以二连杆平面臂为例，正运动学与雅可比
q1, q2 = 0.5, 0.8      # 关节角 rad
l1, l2 = 0.4, 0.3      # 连杆长度 m
x = l1*cos(q1) + l2*cos(q1+q2)
y = l1*sin(q1) + l2*sin(q1+q2)
J = [[-l1*sin(q1)-l2*sin(q1+q2), -l2*sin(q1+q2)],
     [ l1*cos(q1)+l2*cos(q1+q2),  l2*cos(q1+q2)]]
# 可操作度 w = sqrt(det(J·Jᵀ))

三、动力学基础：力矩、惯量与耦合

动力学回答“施加多大力矩才能产生期望运动”。标准形式为：

M(q)·q̈ + C(q,q̇)·q̇ + G(q) + F(q̇) = τ

其中 M(q) 为惯性矩阵，C 为科氏力与离心力项，G 为重力项，F 为摩擦项，τ 为关节驱动力矩。多轴系统的难点在于：惯性矩阵非对角，关节之间存在强耦合——一个关节加速会通过 C 项影响其他关节。实时Linux下，动力学计算需在 1 ms 甚至更短周期内完成，通常采用递归牛顿-欧拉法（RNEA）降低计算量。

四、多轴协调控制概念

多轴协调控制的目标不是让每个关节独立跟踪，而是让多个关节在时间与空间上同步，保证末端轨迹精度与动态一致性。常见策略包括：

• 关节空间协调：各关节按同一插补周期更新，使用 S 曲线或梯形速度规划，保证加减速连续。
• 笛卡尔空间协调：在任务空间规划末端轨迹，再通过逆解分配到各关节，需处理奇异与关节限位。
• 力/位混合协调：在装配、打磨等场景中，部分方向控位置、部分方向控力，需多轴协同分配。
• 时间同步：实时Linux通过 PTP 或 EtherCAT 分布式时钟，使各轴采样与输出偏差控制在微秒级。

协调控制的核心指标是同步误差与轮廓误差。前者衡量轴间时间一致性，后者衡量末端偏离期望轨迹的程度。二者共同决定机器人能否完成高精度作业。

五、常见机器人构型对比

不同构型对应不同的关节组合与控制重点。下表梳理典型构型及其特征：

六、案例与误区复盘

案例：六轴机械臂高速搬运。某产线要求 0.8 s 内完成 300 mm 位移。若仅用关节空间梯形规划，末端轨迹会偏离直线，导致抓取失败。改进方案：在笛卡尔空间做直线插补，再以阻尼最小二乘求逆解，同时加入动力学前馈补偿科氏力，最终轮廓误差从 2.1 mm 降至 0.3 mm。

复盘要点：先明确构型与关节类型，再建立运动学与动力学模型，最后根据任务选择协调策略。实时Linux提供的是确定性执行环境，而控制品质仍取决于模型精度、参数辨识与同步机制。只有将几何、力学与实时调度统一考虑，多轴关节控制才能达到工程可用水平。