四旋翼控制——坐标变换问题

对坐标轴进行逆时针旋转

从机体坐标系转向地面坐标系: R b e = [ x b e , y b e , z b e ] R_b^e=[x_b^e,y_b^e,z_b^e] Rbe=[xbe,ybe,zbe],也就是说,旋转矩阵中三列就是机体坐标系的三个轴在地面坐标系上的投影

  1. O Z b OZ_b OZb轴旋转 ψ \psi ψ
    如图所示, O Z b OZ_b OZb轴垂直于屏幕指向内
    在这里插入图片描述
    R 3 = ( c o s ψ − s i n ψ 0 s i n ψ c o s ψ 0 0 0 1 ) R_3 = \begin{pmatrix}cos\psi & -sin\psi&0 \\ sin\psi & cos\psi &0 \\0 &0&1\end{pmatrix} R3=cosψsinψ0sinψcosψ0001

  2. O X b OX_b OXb轴旋转 ϕ \phi ϕ
    如图所示, O X b OX_b OXb轴垂直于屏幕指向内
    在这里插入图片描述
    R 1 = ( 1 0 0 0 c o s ϕ − s i n ϕ 0 s i n ϕ c o s ϕ ) R_1 = \begin{pmatrix}1 & 0 &0 \\ 0 & cos\phi & -sin\phi\\0 & sin\phi& cos\phi \end{pmatrix} R1=1000cosϕsinϕ0sinϕcosϕ

  3. O Y b OY_b OYb轴旋转 θ \theta θ
    如图所示, O Y b OY_b OYb轴垂直于屏幕指向内
    在这里插入图片描述
    R 2 = ( c o s θ 0 s i n θ 0 1 0 − s i n θ 0 c o s θ ) R_2 = \begin{pmatrix} cos\theta& 0 &sin\theta \\ 0 & 1& 0\\-sin\theta & 0& cos\theta\end{pmatrix} R2=cosθ0sinθ010sinθ0cosθ

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值