[發明專利]基于角速度的歐拉角多項式類指數近似輸出方法

有效

• 申請號: 201110380327.2
• 申請日: 2011-11-25
• 公開（公告）號: CN102506869A
• 公開（公告）日: 2012-06-20
• 發明（設計）人: 史忠科
• 申請（專利權）人: 西北工業大學
• 主分類號: G01C21/24
• 分類號: G01C21/24
• 代理公司: 西北工業大學專利中心 61204
• 代理人: 王鮮凱

技術領域

本發明涉及一種飛行器機動飛行姿態確定方法，特別是涉及一種基于角速度的歐拉角多項式類指數近似輸出方法。?

背景技術

慣性設備在運動體導航和控制中具有重要作用；剛體運動的加速度、角速度和姿態等通常都依賴于慣性設備輸出，因此提高慣性設備的輸出精度具有明確的實際意義；在慣性設備中，加速度采用加速度計、角速度采用角速率陀螺直接測量方式，剛體的姿態精度要求很高時如飛行試驗等采用姿態陀螺測量，但在很多應用領域都有角速度等測量直接解算輸出；主要原因是由于動態姿態傳感器價格昂貴、體積大，導致很多飛行器采用角速率陀螺等解算三個歐拉角，使得姿態時間更新輸出成為導航等核心內容，也使其成為影響慣導系統精度的主要因素之一，因此設計和采用合理的姿態時間更新輸出方法就成為研究的熱點課題；從公開發表的文獻中對姿態輸出主要基于角速度采用歐拉方程直接近似法或采用近似龍格庫塔方法解算(孫麗、秦永元，捷聯慣導系統姿態算法比較，中國慣性技術學報，2006，Vol.14(3)：6-10；Pu?Li，Wang?TianMiao，Liang?JianHong，Wang?Song，An?Attitude?Estimate?Approach?using?MEMS?Sensors?for?Small?UAVs，2006，IEEE?International?Conference?on?Industrial?Informatics，1113-1117)；由于歐拉方程中三個歐拉角互相耦合，屬于非線性微分方程，在不同初始條件和不同飛行狀態下的誤差范圍不同，難以保證實際工程要求的精度。?

發明內容

為了克服現有的飛行器機動飛行時歐拉角輸出精度差的問題，本發明提供一種基于角速度的歐拉角多項式類指數近似輸出方法。該方法通過引入多個參數并采用可以描述任意有限的統一多項式對滾轉、俯仰、偏航角速度p，q，r進行近似逼近描述，通過按照依次求解俯仰角、滾轉角、偏航角，直接對歐拉角的表達式進行高階逼近積分，使得歐拉角的求解按照超線性逼近，從而可以保證確定歐拉角的時間更新迭代計算精度和慣性單元的輸出精度。?

本發明解決其技術問題所采用的技術方案是：一種基于角速度的歐拉角多項式類指數近似輸出方法，其特點是包括以下步驟：?

1、(a)根據歐拉方程：?

式中：?ψ分別指滾轉、俯仰、偏航角；p，q，r分別為滾轉、俯仰、偏航角速度；全文參數定義相同；這三個歐拉角的計算按照依次求解俯仰角、滾轉角、偏航角的步驟進行；滾轉、俯仰、偏航角速度p，q，r的展開式分別為?

p(t)＝pMξ，q(t)＝qMξ，r(t)＝rMξ?

其中?

p＝[p₀?p₁?L?p_n-1?p_n]q＝[q₀?q₁?L?q_n-1?q_n]?

r＝[r₀?r₁?L?r_n-1?r_n]ξ＝[1?t?L?t^n-1?tⁿ]^T

M為事先定義的常數矩陣；定義T為采樣周期，全文符號定義相同；?

(b)俯仰角的時間更新求解式為：?

式中：?