六轴机器人雅可比矩阵计算方法
一、雅可比矩阵定义
对于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} 中表示）