坐标系:下标e表示地球坐标系,下标b表示机体坐标系。
假设:地球坐标系为惯性坐标系。
用
v
⃗
\vec{v}
v表示任意一个向量
v
⃗
e
\vec{v}_e
ve表示向量在地球系的坐标表示,是个
3
×
1
3\times1
3×1向量。
v
⃗
b
\vec{v}_b
vb表示向量在机体系的坐标表示,是个
3
×
1
3\times1
3×1向量。
v
⃗
e
=
R
b
e
v
⃗
b
\vec{v}_e=R_b^e \vec{v}_b
ve=Rbevb
二端同时对时间求导数:
v
⃗
˙
e
=
R
b
e
v
⃗
˙
b
+
R
˙
b
e
v
⃗
b
\dot{\vec{v}}_e=R_b^e \dot{\vec{v}}_b+\dot{R}_b^e\vec{v}_b
v˙e=Rbev˙b+R˙bevb
应用旋转矩阵导数公式:
d
R
b
e
d
t
=
R
b
e
[
ω
b
⃗
]
×
\frac{d{R_b^e}}{dt}=R_b^e[\vec{\omega_b}]_{\times}
dtdRbe=Rbe[ωb]×
得到:
v
⃗
˙
e
=
R
b
e
v
⃗
˙
b
+
R
b
e
[
ω
b
⃗
]
×
v
⃗
b
\dot{\vec{v}}_e=R_b^e \dot{\vec{v}}_b+R_b^e[\vec{\omega_b}]_{\times}\vec{v}_b
v˙e=Rbev˙b+Rbe[ωb]×vb
或者:
R
e
b
v
⃗
˙
e
=
v
⃗
˙
b
+
[
ω
b
⃗
]
×
v
⃗
b
R_e^b \dot{\vec{v}}_e=\dot{\vec{v}}_b+[\vec{\omega_b}]_{\times}\vec{v}_b
Rebv˙e=v˙b+[ωb]×vb
对于飞行器而言:以速度向量为研究目标,结合牛顿第二运动定律。
v
⃗
˙
e
=
F
m
=
F
n
o
n
G
+
G
m
=
A
c
c
e
+
g
e
\dot{\vec{v}}_e=\frac{F}{m}=\frac{F_{nonG}+G}{m}=Acc_e+g_e
v˙e=mF=mFnonG+G=Acce+ge
R
e
b
v
⃗
˙
e
=
R
e
b
A
c
c
e
+
R
e
b
g
e
=
[
a
x
a
y
a
z
]
+
g
b
R_e^b \dot{\vec{v}}_e=R_e^bAcc_e+R_e^bg_e=\left[ \begin{matrix} a_x\\ a_y\\ a_z \end{matrix} \right]+g_b
Rebv˙e=RebAcce+Rebge=⎣⎡axayaz⎦⎤+gb
v
⃗
b
=
[
u
v
w
]
\vec{v}_b=\left[ \begin{matrix} u\\ v\\ w \end{matrix} \right]
vb=⎣⎡uvw⎦⎤
ω ⃗ b = [ p q r ] \vec{\omega}_b=\left[ \begin{matrix} p\\ q\\ r \end{matrix} \right] ωb=⎣⎡pqr⎦⎤
得到:
[ u ˙ v ˙ w ˙ ] = [ a x a y a z ] + g b − [ p q r ] × [ u v w ] \left[ \begin{matrix} \dot{u}\\ \dot{v}\\ \dot{w} \end{matrix} \right]=\left[ \begin{matrix} a_x\\ a_y\\ a_z \end{matrix} \right]+g_b-\left[ \begin{matrix} p\\ q\\ r \end{matrix} \right] \times\left[ \begin{matrix} u\\ v\\ w \end{matrix} \right] ⎣⎡u˙v˙w˙⎦⎤=⎣⎡axayaz⎦⎤+gb−⎣⎡pqr⎦⎤×⎣⎡uvw⎦⎤
该方程式即为飞行器的力学方程组。