当前位置:   article > 正文

无人机刚体动力学方程_无人机动力学方程

无人机动力学方程

无人机平动动力学

推导

无人机相对地球(地心地固坐标系)表面的速度与惯性速度的关系可表示为
v I = v E + ω I E × r (1.1) \bm{v}^I=\bm{v}^E+\bm{\omega}^{IE}\times\bm{r} \tag{1.1} vI=vE+ωIE×r(1.1)
v E \bm{v}^E vE相对于机体系求导
( d d t ) B v E = ( d d t ) I v E − ω I B × v E (1.2) \left(\frac{\mathrm{d}}{\mathrm{d}t}\right)^B\bm{v}^E=\left(\frac{\mathrm{d}}{\mathrm{d}t}\right)^I\bm{v}^E-\bm{\omega}^{IB}\times\bm{v}^E \tag{1.2} (dtd)BvE=(dtd)IvEωIB×vE(1.2)
根据矢量在旋转坐标系下的求导规则,对式(1.1)两边在惯性坐标系下求导
a I = [ ( d d t ) I v E + ω I E × v E ] + [ α I E × r + ω I E × ( ω I E × r ) ] (1.3) \bm{a}^I=\left[\left(\frac{\mathrm{d}}{\mathrm{d}t}\right)^I\bm{v}^E + \bm{\omega}^{IE}\times\bm{v}^E\right] + \left[\bm{\alpha}^{IE}\times\bm{r} + \bm{\omega}^{IE}\times\left(\bm{\omega}^{IE}\times\bm{r}\right)\right] \tag{1.3} aI=[(dtd)IvE+ωIE×vE]+[αIE×r+ωIE×(ωIE×r)](1.3)
(1.3)式中, a I \bm{a}^I aI为惯性加速度,有
a I = f + μ (1.4) \bm{a}^I=\bm{f}+\bm{\mu} \tag{1.4} aI=f+μ(1.4)
(1.4)式中, f \bm{f} f为无人机比力, μ \bm{\mu} μ为万有引力加速度。
地球万有引力加速度与地球重力加速度的关系为
g = μ − [ α I E × r + ω I E × ( ω I E × r ) ] (1.5) \bm{g}=\bm{\mu}-\left[\bm{\alpha}^{IE}\times\bm{r} + \bm{\omega}^{IE}\times\left(\bm{\omega}^{IE}\times\bm{r}\right)\right] \tag{1.5} g=μ[αIE×r+ωIE×(ωIE×r)](1.5)
即重力加速度是万有引力加速度去除了地球自转引起的加速度项的影响。
α I E \bm{\alpha}^{IE} αIE为地球自转加速度,可认为地球为匀速转动,因此此项为0。将(1.3)(1.4)带入(1.2)中整理可得
( d d t ) B v E = f + μ − ω I E × v E − [ α I E × r + ω I E × ( ω I E × r ) ] − ω I B × v E (1.6) \left(\frac{\mathrm{d}}{\mathrm{d}t}\right)^B\bm{v}^E = \bm{f}+\bm{\mu} - \bm{\omega}^{IE}\times\bm{v}^E - \left[\bm{\alpha}^{IE}\times\bm{r} + \bm{\omega}^{IE}\times\left(\bm{\omega}^{IE}\times\bm{r}\right)\right]-\bm{\omega}^{IB}\times\bm{v}^E \tag{1.6} (dtd)BvE=f+μωIE×vE[αIE×r+ωIE×(ωIE×r)]ωIB×vE(1.6)
将式(1.5)带入式(1.6)可得
( d d t ) B v E = f + g − ω I E × v E − ω I B × v E (1.7) \left(\frac{\mathrm{d}}{\mathrm{d}t}\right)^B\bm{v}^E = \bm{f}+\bm{g} - \bm{\omega}^{IE}\times\bm{v}^E - \bm{\omega}^{IB}\times\bm{v}^E \tag{1.7} (dtd)BvE=f+gωIE×vEωIB×vE(1.7)
式(1.7)在机体系下的投影可表示为
a B E B = f B + g B − ω B I E × v B E − ω B I B × v B E (1.8) \bm{a}^{EB}_B = \bm{f}_B+\bm{g}_B - \bm{\omega}^{IE}_B\times\bm{v}^E_B - \bm{\omega}^{IB}_B\times\bm{v}^E_B \tag{1.8} aBEB=fB+gBωBIE×vBEωBIB×vBE(1.8)

应用

求解式(1.8)微分方程,可以得到无人机的速度在机体系下的表示。
f B + g B \bm{f}_B+\bm{g}_B fB+gB为无人机动力、气动力、重力等合外力产生的加速度,合起来可以表示为
f B + g B = F B m + M B N [ 0 0 g ] (1.9) \bm{f}_B+\bm{g}_B=\frac{\bm{F}_B}{m}+\bm{M}_{BN}

[00g]
\tag{1.9} fB+gB=mFB+MBN 00g (1.9)
ω B I E \bm{\omega}^{IE}_B ωBIE为地球转动角速度在机体系下的投影,可以表示为
ω B I E = M B N M N E [ 0 0 ω I E ] = M B N [ − sin ⁡ μ cos ⁡ λ − sin ⁡ μ sin ⁡ λ − cos ⁡ μ − sin ⁡ λ cos ⁡ λ 0 − cos ⁡ μ cos ⁡ λ − cos ⁡ μ sin ⁡ λ − sin ⁡ μ ] [ 0 0 ω I E ] (1.10) \bm{\omega}^{IE}_B=\bm{M}_{BN}\bm{M}_{NE}
[00ωIE]
=\bm{M}_{BN}
[sinμcosλsinμsinλcosμsinλcosλ0cosμcosλcosμsinλsinμ]
[00ωIE]
\tag{1.10}
ωBIE=MBNMNE 00ωIE =MBN sinμcosλsinλcosμcosλsinμsinλcosλcosμsinλcosμ0sinμ 00ωIE (1.10)

ω B I B \bm{\omega}^{IB}_B ωBIB为无人机转动角速度在机体系下的投影,即陀螺仪的测量值。
带入式(1.8)可得
v ˙ B E = F B m + M B N [ 0 0 g ] − M B N [ − sin ⁡ μ cos ⁡ λ − sin ⁡ μ sin ⁡ λ − cos ⁡ μ − sin ⁡ λ cos ⁡ λ 0 − cos ⁡ μ cos ⁡ λ − cos ⁡ μ sin ⁡ λ − sin ⁡ μ ] [ 0 0 ω I E ] × v B E − ω B I B × v B E (1.11) \bm{\dot{v}}^{E}_B = \frac{\bm{F}_B}{m}+\bm{M}_{BN}
[00g]
- \bm{M}_{BN}
[sinμcosλsinμsinλcosμsinλcosλ0cosμcosλcosμsinλsinμ]
[00ωIE]
\times\bm{v}^E_B - \bm{\omega}^{IB}_B\times\bm{v}^E_B \tag{1.11}
v˙BE=mFB+MBN 00g MBN sinμcosλsinλcosμcosλsinμsinλcosλcosμsinλcosμ0sinμ 00ωIE ×vBEωBIB×vBE(1.11)

根据当前姿态转换矩阵、经纬度、陀螺仪测量角速度、机体系合外力、当前重力加速度可以求解微分方程(1.11),得到无人机速度在机体系下的分量。经过姿态转换矩阵,可得到无人机在NED坐标系下的速度。

无人机转动动力学

无人机刚体绕质心转动的过程可以由欧拉动力学方程描述
ω ˙ I B = I − 1 [ M − ω I B × ( I ω I B ) ] (2.1) \bm{\dot{\omega}}^{IB}=\bm{I}^{-1}\left[\bm{M}-\bm{\omega}^{IB}\times\left(\bm{I}\bm{\omega}^{IB}\right)\right] \tag{2.1} ω˙IB=I1[MωIB×(IωIB)](2.1)
其中, ω I B \bm{\omega}^{IB} ωIB为机体系相对惯性系转动的角速度,可由陀螺仪测量出。 I \bm{I} I为原点在刚体质心的惯量矩阵,可表示为
I = [ I x x − I x y − I x z − I y x I y y − I y z − I z x − I z y I z z ] (2.2) \bm{I}=

[IxxIxyIxzIyxIyyIyzIzxIzyIzz]
\tag{2.2} I= IxxIyxIzxIxyIyyIzyIxzIyzIzz (2.2)
对于结构上关于x-z、y-z平面对称的多旋翼,惯量矩阵可以简化为对角阵,即 I = diag { I x x   I y y   I z z } \bm{I}=\textup{diag}\{I_{xx}\:I_{yy}\:I_{zz}\} I=diag{IxxIyyIzz}
(2.1)式在机体系下的投影表达式为
ω ˙ B I B = I − 1 [ M B − ω B I B × ( I ω B I B ) ] (2.3) \bm{\dot{\omega}}^{IB}_B=\bm{I}^{-1}\left[\bm{M}_B-\bm{\omega}^{IB}_B\times\left(\bm{I}\bm{\omega}^{IB}_B\right)\right] \tag{2.3} ω˙BIB=I1[MBωBIB×(IωBIB)](2.3)
根据当前的合外力矩、无人机惯量矩阵求解微分方程(2.3),可以得到无人机相对惯性系转动角速度在机体系下的分量。
得出 ω I B \bm{\omega}^{IB} ωIB后,可容易得出机体系相对于NED坐标系的转动角速度:
ω B N B = ω B I B − ω B I E − ω B E N (2.4) \bm{\omega}^{NB}_B=\bm{\omega}^{IB}_B - \bm{\omega}^{IE}_B - \bm{\omega}^{EN}_B \tag{2.4} ωBNB=ωBIBωBIEωBEN(2.4)
其中, ω B E N \bm{\omega}^{EN}_B ωBEN可以表示为
ω B E N = M B N [ − u R N + h v R E + h − v tan ⁡ μ R E + h ] \bm{\omega}^{EN}_B=\bm{M}_{BN}
[uRN+hvRE+hvtanμRE+h]
ωBEN=MBN RN+huRE+hvRE+hvtanμ

声明:本文内容由网友自发贡献,不代表【wpsshop博客】立场,版权归原作者所有,本站不承担相应法律责任。如您发现有侵权的内容,请联系我们。转载请注明出处:https://www.wpsshop.cn/w/AllinToyou/article/detail/708045
推荐阅读
相关标签
  

闽ICP备14008679号