旋转矩阵公式推导

  
  1.在二维平面中:如下图所示,在 xoy  平面中有一向量 op=(x,y) T   ,旋转 ϕ  角后变为向量 op  =(x  ,y  ) T  
  

旋转矩阵公式推导_第1张图片

  据图可得: x=|op|cosθy=|op|sinθ  ,经旋转 ϕ  角后有:
   x  =|op|cos(θ+ϕ)=|op|(cosθcosϕsinθsinϕ)=xcosϕysinϕ 
   y  =|op|sin(θ+ϕ)=|op|(sinθcosϕ+cosθsinϕ)=xsinϕ+ycosϕ 
写成矩阵形式:
   (x  y   )=(cosϕsinϕ sinϕcosϕ )(xy ) 
  2.在三维空间中:如下图所示,若以坐标系的三个坐标轴X、Y、Z分别作为旋转轴,则点实际上只在垂直坐标轴的平面上作二维旋转。
旋转矩阵公式推导_第2张图片

  例: op  绕X轴旋转 ϕ  角,有:
旋转前: 这里写图片描述
旋转后: 这里写图片描述
写成矩阵形式: 这里写图片描述
则绕X轴旋ϕ角的旋转矩阵为: R x (ϕ)=100 0cosϕsinϕ 0sinϕcosϕ  
同理可得绕X、Y、Z轴旋转的不同角度的旋转矩阵(方向余弦矩阵)分别为:
这里写图片描述

  最后,若 op  绕某一定轴旋转,从欧拉定律中可知,绕着固定轴做一个角值的旋转,可以被视为分别以坐标系的三个坐标轴X、Y、Z作为旋转轴的旋转的叠加。
  

你可能感兴趣的:(无人机(Unmanned,Aerial,Vehicle))