锐单电子商城 , 一站式电子元器件采购平台!
  • 电话:400-990-0325

UR3机器人雅克比矩阵

时间:2022-08-16 17:30:00 1j22铁钴钒合金电阻率t40fm扭矩传感器ry1s2j11r1压力变送器

本文链接

3 雅可比矩阵

3.1 概念

??根据正运动学分析,只要我们知道机器人的结构和每个关节的位置(旋转关节的角度或移动关节的平移),我们就可以找到终端执行器的位置,即终端执行器的位置与关节的位置有以下关系:
x ? = f ( θ ? ) (1) \vec{x}=f(\vec\theta)\tag{1} x =f(θ )(1)
其中, x ? \vec x x 表示末端执行器的位姿, θ ⃗ \vec\theta θ 表示关节角度。

  对式(1)两边同时对时间 t t t求导可得:
d x ⃗ d t = d f ( θ ⃗ ) d t = d f ( θ ⃗ ) d θ ⃗ ⋅ d θ ⃗ d t (2) \frac{\mathrm d\vec x}{\mathrm d t}=\frac{\mathrm df(\vec \theta)}{\mathrm dt}=\frac{\mathrm df( \vec\theta)}{\mathrm d\vec\theta}·\frac{\mathrm d\vec\theta}{\mathrm dt}\tag{2} dtdx =dtdf(θ )=dθ df(θ )dtdθ (2)
即:
x ˙ = d x ⃗ d θ ⃗ ⋅ θ ˙ = J ( θ ) ⋅ θ ˙ (3) \dot x=\frac{\mathrm d\vec x}{\mathrm d\vec\theta}·\dot\theta=J(\theta)·\dot\theta\tag{3} x˙=dθ dx θ˙=J(θ)θ˙(3)

  矩阵 J ( θ ) J(\theta) J(θ)即为机器人的雅可比矩阵,它将机器人关节空间的速度与操作空间的速度联系起来。这里需要注意 x ⃗ \vec{x} x x ⃗ \vec{x} x 的描述有多种形式,其位置和姿态可以表示在笛卡尔坐标系、柱坐标系、球坐标系等不同坐标系下,其姿态可以表示为欧拉角、四元数等等。随着 x ⃗ \vec{x} x 的描述不同,雅可比矩阵 J ( θ ) J(\theta) J(θ)也会随之变化。为方便起见,定义基本雅可比矩阵,即用笛卡尔坐标描述线速度和角速度、以机械臂的基准坐标系(即坐标系 { 0 } \{0\} { 0})作为参照系来描述末端执行器速度所求得的雅可比矩阵。(如无特殊说明,以下提到的雅可比矩阵均指基本雅可比矩阵)

3.2 UR3基本雅可比矩阵的求解

  根据基本雅可比矩阵的定义,末端执行器的速度可以写为:
x ˙ = [ v x v y v z ω x ω y ω z ] = [ v ⃗ ω ⃗ ] (4) \dot x= \begin{bmatrix} v_x \\v_y\\v_z\\\omega_x\\\omega_y\\\omega_z \end{bmatrix} = \begin{bmatrix} \vec v \\\vec \omega \end{bmatrix}\tag{4} x˙= vxvyvzωxωyωz =[v ω ](4)
雅可比矩阵应为 6 ∗ 6 6*6 66的矩阵,可以写成:
J = [ J v J ω ] (5) J= \begin{bmatrix} J_v \\J_\omega \end{bmatrix}\tag{5} J=[JvJω](5)
上半部分对应线速度,下半部分对应角速度。

3.2.1 线速度部分

  由正运动学部分可以得到,末端执行器位姿矩阵为:
T 6 0 = [ n x o x a x p x n y o y a y p y n z o z a z p z 0 0 0 1 ] (6) T^0_6 = \begin{bmatrix} n_x & o_x & a_x & p_x \\ n_y & o_y & a_y & p_y \\ n_z & o_z & a_z & p_z \\ 0 & 0 & 0 & 1 \end{bmatrix}\tag{6} T60= nxnynz0oxoyoz0axayaz0pxpypz1 (6)

  其中 p x p_x px p y p_y py p z p_z pz即为末端执行器在坐标系 { 0 } \{0\} { 0}下的位置,因此,要求雅可比矩阵线速度部分 J v J_v Jv,只需要将 p x p_x

相关文章