座標變換(5)—用旋轉軸和旋轉角表示旋轉

任何旋轉,都可以用一個旋轉軸 ω ^ \hat \omega 和一個旋轉角 θ \theta 來描述。

1. 座標系的線速度和角速度

如上圖,在旋轉的剛體上,附加一個body frame { b } \{b\} ,記爲 { x ^ , y ^ , z ^ } \{\hat{x},\hat{y},\hat{z}\} 。對於三個軸而言,繞着 ω ^ \hat \omega 旋轉的軌跡爲圓。當然,上述座標軸 { x ^ , y ^ , z ^ } \{\hat{x},\hat{y},\hat{z}\} ω ^ \hat \omega 是在fixed frame { S } \{S\} 座標系下的,下面將 ω ^ \hat \omega 記爲 ω ^ s \hat \omega_s

繞着軸 ω ^ \hat \omega 的角速度爲,
w s = w ^ θ ˙ (1) w_s=\hat{w}\dot{\theta} \tag{1}
運動的線速度記爲 x ^ ˙ \dot{\hat{x}} ,三個軸的線速度則爲,
x ^ ˙ = w s × x ^ y ^ ˙ = w s × y ^ z ^ ˙ = w s × z ^ (2) \begin{aligned} \dot{\hat{x}}&=w_s \times \hat{x} \\ \dot{\hat{y}}&=w_s \times \hat{y} \\ \dot{\hat{z}}&=w_s \times \hat{z} \end{aligned} \tag{2}
將三個軸的線速度統一寫爲,
R ˙ = [ w s × x ^ w s × y ^ w s × z ^ ] = w s × R (3) \dot{R}= \begin{bmatrix} w_s \times \hat{x} & w_s \times \hat{y} & w_s \times \hat{z} \end{bmatrix}=w_s \times R \tag{3}
爲了簡化公式(3)中的叉乘,特引入了 [ ] [] 符號,將 w × R w \times R 可以記爲矩陣的乘法 [ w ] R [w]R ,其中 [ w ] [w] 的定義如下:
對於 R 3 \mathbb{R}^3 中的向量 x = [ x 1 x 2 x 3 ] x=\begin{bmatrix}x_1 & x_2 &x_3\end{bmatrix} ,定義 [ x ] [x] 爲一個反對稱矩陣,
[ x ] = [ 0 x 3 x 2 x 3 0 x 1 x 2 x 1 0 ] (4) [x]=\left[\begin{array}{ccc} 0 & -x_{3} & x_{2} \\ x_{3} & 0 & -x_{1} \\ -x_{2} & x_{1} & 0 \end{array}\right]\tag{4}
[ x ] = [ x ] T (5) [x]=-[x]^T \tag{5}
上述所有 3 × 3 3 \times 3 的反對稱矩陣統稱爲 s o ( 3 ) so(3) 小的。前面說過,旋轉矩陣屬於 S O ( 3 ) SO(3) 大的。下面有一個兩者結合起來有趣的性質,假定 r i T r_i^T R R 的第 i i 行,即 r i r_i R T R^T 的第 i i 列,則
R [ w ] R T = R [ w s × r 1 w s × r 2 w s × r 3 ] = [ r 1 T ( w s × r 1 ) r 1 T ( w s × r 2 ) r 1 T ( w s × r 3 ) r 2 T ( w s × r 1 ) r 2 T ( w s × r 2 ) r 2 T ( w s × r 3 ) r 3 T ( w s × r 1 ) r 3 T ( w s × r 2 ) r 3 T ( w s × r 3 ) ] = [ 0 r 3 T w s r 2 T w s r 3 T w s 0 r 1 T w s r 2 T w s r 1 T w s 0 ] = [ R w s ] (6) \begin{aligned} R[w]R^T &= R\begin{bmatrix} w_s\times r_1 & w_s\times r_2 &w_s\times r_3 \end{bmatrix}\\ &= \begin{bmatrix} r_1^{T}(w_s\times r_1) & r_1^T(w_s\times r_2) & r_1^T (w_s\times r_3) \\ r_2^{T}(w_s\times r_1) & r_2^T(w_s\times r_2) & r_2^T (w_s\times r_3) \\ r_3^{T}(w_s\times r_1) & r_3^T(w_s\times r_2) & r_3^T (w_s\times r_3) \end{bmatrix} \\ &= \begin{bmatrix} 0 & -r_3^Tw_s & r_2^Tw_s\\ r_3^Tw_s & 0 &-r_1^Tw_s\\ -r_2^Tw_s&r_1^Tw_s&0 \end{bmatrix}\\ &=[Rw_s] \end{aligned} \tag{6}

對於(6)中矩陣中的 r 1 T ( w s × r 2 ) r_1^{T}(w_s\times r_2) r3Tws0r1Twsr2Twsr1Tws0=[Rws](6)

對於(6)中矩陣中的 r 1 T ( w s × r 2 ) r_1^{T}(w_s\times r_2) ws0

相關文章
相關標籤/搜索