罗德里格斯公式推导

版权声明：本文为博主原创文章，未经博主允许不得转载。 https://blog.csdn.net/xuewend/article/details/84635510

引言

k为单位向量，向量v绕旋转轴k旋转Θ得到向量v_rot, 那么就有下面的旋转方程使等式成立：
v_rot = Rv
而这个旋转方程就是罗德里格斯方程：
R=cosΘ I + (1 - cosΘ )kk^τ + sinΘK

下面开始推导：

推导：

向量分解 ,
v _// = (v•k)k (向量点乘得标量，k为单位向量)
v_rot = v_rot⊥ + v _//
v_rot⊥ = a + b
由图中的向量关系可得：b= cosΘ v_⊥ a=sinΘ k x v

v_rot = v_rot⊥+v_//

= a + b + v_//

= sinΘ k x v + cosΘ v_⊥ + (v • k)k

= sinΘ k x v + cosΘ (v - v_//)+ (v • k)k

= sinΘ k x v + cosΘ (v - (v • k)k)+ (v • k)k

= cosΘ v + (1 - cosΘ )(v • k)k + sinΘ k x v
　　　　　　
所以:
cosΘ v + (1 - cosΘ )(v • k)k + sinΘ k x v

= cosΘ v + (1 - cosΘ )kk^τv + sinΘKv

=( cosΘ I + (1 - cosΘ )kk^τ + sinΘK ) v

=Rv