坐标变换(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

相关文章
相关标签/搜索