六轴机器人雅可比矩阵计算方法

一、雅可比矩阵定义

对于6自由度串联机器人，末端执行器的广义速度（线速度 v 和角速度 ω）与关节速度 q̇ = [q̇₁, q̇₂, q̇₃, q̇₄, q̇₅, q̇₆]ᵀ 的关系为：

⎡ v ⎤
⎢ ⎥ = J(q) q̇
⎣ ω ⎦

其中：

• J(q) ∈ ℝ⁶ˣ⁶ 是几何雅可比矩阵
• q = [q₁, q₂, q₃, q₄, q₅, q₆]ᵀ 为关节角度向量
• v ∈ ℝ³ 为末端线速度（单位：m/s）
• ω ∈ ℝ³ 为末端角速度（单位：rad/s）

二、雅可比矩阵的列构造（适用于旋转关节）

工业六轴机器人通常全部为旋转关节。第 i 列 Jᵢ（i = 1～6）的计算公式为：

Jᵢ = ⎡ zᵢ₋₁ × (oₑ − oᵢ₋₁) ⎤
⎣ zᵢ₋₁ ⎦

其中：

• zᵢ₋₁：第 (i−1) 号坐标系的 z 轴单位向量（在基坐标系 {0} 中表示）