本文主要簡單介紹固定翼飛機(jī)的數(shù)學(xué)建模的一般形式與原理,讀者姥爺們可以跟著在草稿紙上手動(dòng)推導(dǎo)一次,理解會(huì)更加深刻!
1. 固定翼飛機(jī)的飛行原理
一般地,多旋翼飛機(jī)的飛行原理簡單而易懂:通過機(jī)身裝備的螺旋槳的轉(zhuǎn)動(dòng)產(chǎn)生升力,進(jìn)而獲得 z z z軸上的上下垂直移動(dòng)。通過調(diào)整某個(gè)/某幾個(gè)螺旋槳的轉(zhuǎn)速,就能夠?qū)崿F(xiàn)俯仰、滾轉(zhuǎn)、偏航的姿態(tài)調(diào)整。從力學(xué)基礎(chǔ)角度看,螺旋槳同時(shí)增大/降低轉(zhuǎn)速可以實(shí)現(xiàn)多旋翼的上升/下降,不同螺旋槳之間的轉(zhuǎn)速差引起的轉(zhuǎn)矩則能夠?qū)崿F(xiàn)姿態(tài)機(jī)動(dòng)。
另一方面,由于多旋翼的控制通道往往是解耦的,因而其飛控算法容易實(shí)現(xiàn),調(diào)參難度低,控制律設(shè)計(jì)也相對(duì)容易,經(jīng)常作為專業(yè)相關(guān)學(xué)生的入門接觸對(duì)象。
與旋翼機(jī)相比,固定翼飛機(jī)歷史悠久,飛行難度高,飛行條件苛刻,力學(xué)方程更加復(fù)雜,控制律更難設(shè)計(jì)。其飛行以流體力學(xué)為基礎(chǔ),通過飛行過程中機(jī)翼上下表面的壓差提供升力,因而“無速度就無升力”。固定翼的俯仰、滾轉(zhuǎn)、偏航均通過機(jī)翼和尾翼的舵面來控制。
同時(shí),固定翼飛機(jī)的數(shù)學(xué)模型往往相互耦合,難以設(shè)計(jì)控制律,且實(shí)際工業(yè)中往往通過控制左/右副翼、水平穩(wěn)定翼、垂直穩(wěn)定翼、方向舵、升降舵、推力等等參數(shù)以達(dá)到控制的目的,因而工業(yè)上固定翼飛機(jī)的控制律設(shè)計(jì)更加復(fù)雜。
本文以簡化后的固定翼數(shù)學(xué)建模為基礎(chǔ),在牛頓–歐拉方程基礎(chǔ)上建立固定翼的數(shù)學(xué)模型。
2. 姿態(tài)角設(shè)置
根據(jù)目前最默認(rèn)的設(shè)置,滾轉(zhuǎn)、俯仰、偏航分別為歐拉角
φ
\varphi
φ、
θ
\theta
θ、
ψ
\psi
ψ(機(jī)體坐標(biāo)系),而在地球坐標(biāo)系下,三個(gè)通道的速度分別表示為
p
p
p、
q
q
q、
r
r
r。二者之間通過坐標(biāo)系轉(zhuǎn)換矩陣進(jìn)行轉(zhuǎn)換:
[
p
q
r
]
=
R
e
b
[
φ
˙
θ
˙
ψ
˙
]
=
[
1
0
?
sin
?
θ
0
cos
?
φ
sin
?
φ
cos
?
θ
0
?
sin
?
φ
cos
?
φ
cos
?
θ
]
[
φ
˙
θ
˙
ψ
˙
]
\left[ \begin{matrix} p \\ q \\ r \end{matrix} \right] = R_e^b \left[ \begin{matrix} \dot \varphi \\ \dot \theta \\ \dot \psi \end{matrix} \right] = \left[ \begin{matrix} 1 & 0 & - \sin \theta \\ 0 & \cos \varphi & \sin \varphi \cos \theta \\ 0 & -\sin \varphi & \cos \varphi \cos \theta \end{matrix} \right] \left[ \begin{matrix} \dot \varphi \\ \dot \theta \\ \dot \psi \end{matrix} \right]
?
??pqr??
??=Reb??
??φ˙?θ˙ψ˙???
??=?
??100?0cosφ?sinφ??sinθsinφcosθcosφcosθ??
???
??φ˙?θ˙ψ˙???
??
3. 牛頓–歐拉方程
牛頓–歐拉方程如下:
Ω
˙
b
=
(
J
b
)
?
1
(
M
b
?
Ω
b
×
(
J
b
?
Ω
b
)
)
(1)
\dot \Omega^b = \left( J^b \right) ^ {-1} \left( M^b - \Omega^b \times \left( J^b \cdot \Omega^b \right) \right) \tag{1}
Ω˙b=(Jb)?1(Mb?Ωb×(Jb?Ωb))(1)其中
Ω
=
[
p
q
r
]
T
\Omega = \left[ \begin{matrix} p & q & r \end{matrix}\right]^T
Ω=[p?q?r?]T為姿態(tài)角矩陣,
J
b
J^b
Jb為機(jī)體坐標(biāo)系下固定翼的轉(zhuǎn)動(dòng)慣量矩陣:
J
b
=
[
J
x
0
J
x
z
0
J
y
0
J
z
x
0
J
z
]
(2)
J^b = \left[ \begin{matrix} J_x & 0 & J_{xz} \\ 0 & J_y & 0 \\ J_{zx} & 0 & J_z \end{matrix} \right] \tag{2}
Jb=?
??Jx?0Jzx??0Jy?0?Jxz?0Jz???
??(2)而
M
b
M^b
Mb為外力在俯仰、滾轉(zhuǎn)、偏航三通道上的力矩:
M
b
=
[
q
ˉ
S
b
E
L
q
ˉ
S
c
ˉ
E
M
q
ˉ
S
b
E
N
]
(3)
M^b = \left[ \begin{matrix} \bar q Sb E_L \\ \bar q S \bar c E_M \\ \bar q Sb E_N \end{matrix} \right] \tag{3}
Mb=?
??qˉ?SbEL?qˉ?ScˉEM?qˉ?SbEN???
??(3)其中
q
ˉ
=
1
2
ρ
V
T
2
\bar q = \frac{1}{2} \rho V_T^2
qˉ?=21?ρVT2?為空氣動(dòng)壓,
b
b
b為翼展,
c
ˉ
\bar c
cˉ為機(jī)翼平均弦長;
E
M
,
E
L
,
E
N
E_M, E_L, E_N
EM?,EL?,EN?分別為滾轉(zhuǎn)、俯仰、偏航力矩系數(shù),各自表達(dá)式如下:
E
L
=
C
L
ˉ
β
?
β
+
C
L
δ
r
?
δ
r
+
C
L
δ
a
?
δ
a
+
C
L
p
ˉ
(
p
b
2
V
T
)
+
C
L
r
ˉ
(
r
b
2
V
T
)
E
M
=
C
M
0
+
C
M
α
?
α
+
C
M
δ
e
?
δ
e
+
C
M
α
˙
(
α
˙
c
ˉ
2
V
T
)
+
C
M
q
ˉ
(
q
c
ˉ
2
V
T
)
E
N
=
C
N
β
?
β
+
C
N
δ
a
?
δ
a
+
C
N
δ
r
?
δ
r
+
C
N
p
ˉ
(
p
b
2
V
T
)
+
C
N
r
ˉ
(
r
b
2
V
T
)
(4)
\begin{aligned} E_L &= C_{\bar L \beta} \cdot \beta + C_{L \delta_r} \cdot \delta_r + C_{L \delta_a} \cdot \delta_a + C_{L \bar p} \left( \frac{pb}{2V_T }\right) + C_{L \bar r} \left( \frac{rb}{2V_T }\right) \\ E_M &= C_{M_0} + C_{M \alpha} \cdot \alpha + C_{M \delta_e} \cdot \delta_e + C_{M \dot \alpha} \left( \frac{\dot \alpha \bar c}{2V_T}\right) + C_{M \bar q} \left( \frac{q \bar c}{2V_T}\right) \\ E_N &= C_{N \beta} \cdot \beta + C_{N \delta_a} \cdot \delta_a + C_{N \delta_r} \cdot \delta_r + C_{N \bar p} \left( \frac{pb}{2V_T}\right) + C_{N \bar r} \left( \frac{rb}{2V_T}\right) \end{aligned} \tag{4}
EL?EM?EN??=CLˉβ??β+CLδr???δr?+CLδa???δa?+CLpˉ??(2VT?pb?)+CLrˉ?(2VT?rb?)=CM0??+CMα??α+CMδe???δe?+CMα˙?(2VT?α˙cˉ?)+CMqˉ??(2VT?qcˉ?)=CNβ??β+CNδa???δa?+CNδr???δr?+CNpˉ??(2VT?pb?)+CNrˉ?(2VT?rb?)?(4)其中
δ
r
,
δ
a
,
δ
e
\delta_r, \delta_a, \delta_e
δr?,δa?,δe?分別為尾翼方向舵、左右副翼、尾翼升降舵的控制量。
將(1)(2)(3)(4)聯(lián)立,(1)式可以化為
Ω
˙
b
=
(
J
b
)
?
1
(
M
b
?
Ω
b
×
(
J
b
?
Ω
b
)
)
?
[
p
˙
q
˙
r
˙
]
=
Λ
[
q
ˉ
S
b
E
L
?
J
z
x
p
q
?
J
z
q
r
+
J
y
q
r
q
ˉ
S
c
ˉ
E
M
?
J
x
p
r
?
J
x
z
r
2
+
J
z
x
p
2
+
J
z
p
r
q
ˉ
S
b
E
N
?
J
y
p
q
+
J
x
p
q
+
J
x
z
q
r
]
(5)
\dot \Omega^b = \left( J^b \right) ^ {-1} \left( M^b - \Omega^b \times \left( J^b \cdot \Omega^b \right) \right) \Longrightarrow \\ \left[ \begin{matrix} \dot p \\ \dot q \\ \dot r \end{matrix} \right] = \Lambda \left[ \begin{matrix} \bar q Sb E_L - J_{zx}pq - J_z qr + J_y qr \\ \bar q S \bar c E_M - J_x pr - J_{xz} r^2 + J_{zx} p^2 + J_z pr \\ \bar q Sb E_N - J_y pq + J_x pq + J_{xz}qr \end{matrix} \right] \tag{5}
Ω˙b=(Jb)?1(Mb?Ωb×(Jb?Ωb))??
??p˙?q˙?r˙??
??=Λ?
??qˉ?SbEL??Jzx?pq?Jz?qr+Jy?qrqˉ?ScˉEM??Jx?pr?Jxz?r2+Jzx?p2+Jz?prqˉ?SbEN??Jy?pq+Jx?pq+Jxz?qr??
??(5)其中
Λ
=
(
J
b
)
?
1
=
[
J
z
J
x
J
z
?
J
x
z
J
z
x
0
J
x
z
J
x
z
J
z
x
?
J
x
J
z
0
1
J
y
0
J
z
x
J
x
z
J
z
x
?
J
x
J
z
0
J
x
J
x
J
z
?
J
x
z
J
z
x
]
\Lambda = \left( J^b \right) ^{-1} = \left[ \begin{matrix} \frac{J_z}{J_x J_z - J_{xz} J_{zx}} & 0 & \frac{J_{xz}}{J_{xz} J_{zx} - J_x J_z} \\ 0 & \frac{1}{J_y} & 0 \\ \frac{J_{zx}}{J_{xz} J_{zx} - J_x J_z} & 0 & \frac{J_x}{J_x J_z - J_{xz} J_{zx}} \end{matrix} \right]
Λ=(Jb)?1=?
??Jx?Jz??Jxz?Jzx?Jz??0Jxz?Jzx??Jx?Jz?Jzx???0Jy?1?0?Jxz?Jzx??Jx?Jz?Jxz??0Jx?Jz??Jxz?Jzx?Jx????
??另一方面,由于
E
L
,
E
M
,
E
N
E_L, E_M, E_N
EL?,EM?,EN?表達(dá)式顯含控制量
δ
i
\delta_i
δi?,因而(5)式還可以簡化為
{
p
˙
=
f
1
(
δ
r
,
δ
a
,
p
,
q
,
r
)
q
˙
=
f
2
(
δ
e
,
p
,
q
,
r
)
r
˙
=
f
3
(
δ
r
,
δ
a
,
p
,
q
,
r
)
(6)
\begin{cases} \dot p = f_1 \left( \delta_r, \delta_a, p, q, r \right) \\ \dot q = f_2 \left( \delta_e, p, q, r \right) \\ \dot r = f_3 \left( \delta_r, \delta_a, p, q, r \right) \end{cases} \tag{6}
?
?
??p˙?=f1?(δr?,δa?,p,q,r)q˙?=f2?(δe?,p,q,r)r˙=f3?(δr?,δa?,p,q,r)?(6)文章來源:http://www.zghlxwxcb.cn/news/detail-500627.html
4. 備注
本文只對(duì)固定翼的姿態(tài)角做出了數(shù)學(xué)建模,對(duì)于其位移、氣流角等的進(jìn)一步探討將在后續(xù)給出。
下一節(jié)將會(huì)給出固定翼姿態(tài)角的控制算法與實(shí)例。文章來源地址http://www.zghlxwxcb.cn/news/detail-500627.html
到了這里,關(guān)于固定翼飛機(jī)數(shù)學(xué)建模入門(姿態(tài)角篇)的文章就介紹完了。如果您還想了解更多內(nèi)容,請?jiān)谟疑辖撬阉鱐OY模板網(wǎng)以前的文章或繼續(xù)瀏覽下面的相關(guān)文章,希望大家以后多多支持TOY模板網(wǎng)!