# 7自由度机械臂雅可比轨迹跟随旋转不稳定

> 原文链接：https://robotics.hellobike.com/pitfalls/2017-04-25-robotics-se-6617
> 频道：pitfalls | 更新日期：2017-04-25 | 标签：auto, stackexchange, kinematics, jacobian
> 核心摘要：用轴角表示姿态误差，构造6维笛卡尔误差并经几何雅可比伪逆求关节速度。

# 7自由度机械臂雅可比轨迹跟随旋转不稳定

::: v-pre
> 本文由 AI 根据公开内容整理，可能有误，请以原文为准：[Jacobian-based trajectory following](https://robotics.stackexchange.com/questions/6617/jacobian-based-trajectory-following)（Robotics Stack Exchange #6617）

**状态**：已解决

## 问题

提问者用雅可比控制7自由度机械臂沿世界系笛卡尔轨迹运动，平移正常，但旋转跟随实现不稳定；其方法用`SLERP`算目标姿态，再转欧拉角送入`AngularVelocityJacobian`。

## 环境

Linux / ROS 机器人软件与控制通用开发环境

## 解决办法

1. 不要把相对旋转转成欧拉角作为误差，改用轴角表示姿态误差。
2. 按Sciavicco-Siciliano第3.7.3节公式`3.84`/`3.89`计算姿态误差，并与平移误差组成`6×1`误差向量`e`。
3. 使用几何雅可比`J_G`的伪逆计算关节速度：`q_dot = J_G^+ · e`。
4. 可令`e=[K_P·e_P, K_O·e_O]^T`调节收敛速度，但高增益会放大伪逆在奇异点等情况下的不稳定。

原问题作者：Ben；采纳答案作者：Ugo Pattacini。原内容依 CC BY-SA 4.0 授权，本页摘要同样依 CC BY-SA 4.0 授权。
:::

## 原始参考来源 (Sources)

- [Robotics Stack Exchange #6617：Jacobian-based trajectory following](https://robotics.stackexchange.com/questions/6617/jacobian-based-trajectory-following)