[發(fā)明專利]飛行器的控制方法、裝置和飛行器

有效

• 申請?zhí)枺?/td>: 201711498560.4
• 申請日: 2017-12-29
• 公開（公告）號: CN107943097B
• 公開（公告）日: 2020-07-17
• 發(fā)明（設(shè)計）人: 劉昊;馬騰;蔡國飆;劉德元;趙萬兵
• 申請（專利權(quán)）人: 北京航空航天大學
• 主分類號: G05D1/10
• 分類號: G05D1/10
• 代理公司: 北京超凡志成知識產(chǎn)權(quán)代理事務(wù)所(普通合伙) 11371
• 代理人: 徐彥圣

1.一種飛行器的控制方法，其特征在于，所述方法應(yīng)用于飛行器的控制器；所述方法包括：

采集飛行器的動力系統(tǒng)輸出的初始飛行狀態(tài)參數(shù)；其中，所述初始飛行狀態(tài)參數(shù)包括飛行速度和飛行高度；

根據(jù)所述初始飛行狀態(tài)參數(shù)和預(yù)設(shè)的參考信號，生成初始控制信號；

將所述初始控制信號輸入至所述飛行器的動力系統(tǒng)，采集所述動力系統(tǒng)輸出的當前飛行狀態(tài)參數(shù)，計算所述當前飛行狀態(tài)參數(shù)與所述參考信號之間的誤差信號；

根據(jù)所述誤差信號，生成補償控制信號；

根據(jù)所述初始控制信號和所述補償控制信號，確定所述飛行器的節(jié)流閥和舵偏角控制信號，以對所述飛行器的飛行狀態(tài)進行控制；

所述根據(jù)所述初始飛行狀態(tài)參數(shù)和預(yù)設(shè)的參考信號，生成初始控制信號的步驟，包括：

通過下述公式，計算初始控制信號u_i,H：

u_i,H＝K_i,He_i,i＝1,2,；

其中，i＝1代表飛行速度；i＝2代表飛行高度；K_i,H為次優(yōu)狀態(tài)反饋增益；e_i為誤差信號；

所述次優(yōu)狀態(tài)反饋增益K_i,H，通過下述公式獲得：

其中，ω_n為自然角頻率；ρ為大氣密度；v_trim為所述飛行器在巡航飛行階段平衡狀態(tài)時的速度；S為參考面積；為平均氣動弦長；C_Me為空氣動力系數(shù)；I_yy為轉(zhuǎn)動慣量；

P_i為下述方程的對稱正定解：

a₂₁＝v_trim；a₂₂＝T_trim/m^N/V_trim；C_Tβ0和C_Tβ2為空氣動力系數(shù)；m為飛機質(zhì)量；ζ_n為阻尼比；T_trim為所述飛行器在巡航飛行階段平衡狀態(tài)時的推力；c_1j，j＝1,2,3、c_2j，j＝1,2,3,4和θ_i是權(quán)重參數(shù)；Q_i,i＝1,2是對稱正定矩陣，φ_i，i＝1,2是設(shè)定的衰減因子；上標N表示參數(shù)為標稱參數(shù)；

所述根據(jù)所述誤差信號，生成補償控制信號的步驟，包括：

通過下述公式，計算補償控制信號u_i,R(s)：

其中，s為拉普拉斯算子；F₁(s)＝f₁³/(s+f₁)³，f₁和f₂是設(shè)定的濾波參數(shù)，為正常數(shù)；y₁＝v-r_v，y₂＝h-r_h；v為所述飛行器的速度；h為所述飛行器的高度；r_v為所述飛行器在巡航飛行階段的參考速度；r_h為所述飛行器在巡航飛行階段的參考高度；G_i(s)為從u_i,R(s)至y_i的傳遞函數(shù)；

所述傳遞函數(shù)G_i(s)，通過下述公式獲得：

G_i(s)＝C_i(sI_i-A_i,H)^-1B_i，i＝1,2；

其中，I_i，i＝1,2為單位矩陣；A_i,H＝A_i+B_iK_i,H；

所述根據(jù)所述初始控制信號和所述補償控制信號，確定所述飛行器的節(jié)流閥和舵偏角控制信號，以對所述飛行器的飛行狀態(tài)進行控制的步驟，包括：

計算所述飛行器的最終控制信號u_i＝u_i,H+u_i,R，i＝1,2；

根據(jù)所述最終控制信號控制所述飛行器的飛行速度和/或飛行高度。