專利名稱：一種剛體空間運動狀態的傅里埃輸出方法
技術領域：
本發明涉及空間運動剛體模型，特別涉及飛行器大機動飛行狀態輸出問題。
背景技術：
機體軸系剛體運動微分方程是描述飛行器、魚雷、航天器等空間運動的基本方程。 通常，在數據處理等應用中，體軸系的狀態變量主要包含3個速度分量、三個歐拉角、以及地面坐標系的XE，Ye, &等，由于定義為垂直地面指向地球中心，因此實際為負的飛行高度；通常主要依賴GPS、GNSS、北斗等直接給出；歐拉角表示剛體空間運動姿態，而刻畫剛體姿態的微分方程又是其中的核心，通常以三個歐拉角即俯仰、滾轉和偏航角來描述。 當剛體的俯仰角為士90°時，滾轉角和偏航角無法定值，同時臨近該奇點的區域求解誤差過大，導致工程上不可容忍的誤差而不能使用；為了避免這一問題，人們首先采用限制俯仰角取值范圍的方法，這使得方程式退化，不能全姿態工作，因而難以廣泛用于工程實踐。隨著對飛行器極限飛行的研究，人們又相繼采用了方向余弦法、等效轉動矢量法、四元數法等推算剛體運動姿態。方向余弦法避免了歐拉角描述方法的“奇異”現象，用方向余弦法計算姿態矩陣沒有方程退化問題，可以全姿態工作，但需要求解9個微分方程，計算量較大，實時性較差，無法滿足工程實踐要求。等效轉動矢量法如單子樣遞推、雙子樣轉動矢量、三子樣轉動矢量和四子樣旋轉矢量法以及在此基礎上的各種修正算法和遞推算法等。文獻中研究旋轉矢量時，都是基于速率陀螺輸出為角增量的算法。然而在實際工程中，一些陀螺的輸出是角速率信號，如光纖陀螺、動力調諧陀螺等。當速率陀螺輸出為角速率信號時，旋轉矢量法的算法誤差明顯增大。四元數法是定義4個歐拉角的函數來計算航姿，能夠有效彌補歐拉角描述方法的奇異性，只要解4個一階微分方程式組即可，比方向余弦姿態矩陣微分方程式計算量有明顯的減少，能滿足工程實踐中對實時性的要求。其常用的計算方法有畢卡逼近法、二階、四階龍格-庫塔法和三階泰勒展開法等。畢卡逼近法實質是單子樣算法，對有限轉動引起的不可交換誤差沒有補償，在高動態情況下姿態解算中的算法漂移會十分嚴重。采用四階龍格-庫塔法求解四元數微分方程時，隨著積分誤差的不斷積累，會出現三角函數取值超出士 1的現象，從而導致計算發散；泰勒展開法也因計算精度的不足而受到制約。當剛體大機動時，角速率較大導致上述方法的誤差更大；不僅如此，姿態估計的誤差常常會導致速度4個分量、高度輸出的誤差急劇增大。
發明內容
為了克服現有剛體運動模型輸出誤差大的問題，本發明提供一種剛體空間運動狀態的傅里埃輸出方法，該方法通過定義三元數，使得機體軸系三個速度分量和三元數構成線性微分方程組，并采用傅里埃級數對滾轉、俯仰、偏航角速度P，q，r進行近似逼近描述， 可以按照任意階保持器的方式求解系統的狀態轉移矩陣，進而得到剛體運動離散狀態方程的表達式，避免了姿態方程奇異問題，從而得到剛體主要運動狀態。
5
本發明解決其技術問題采用的技術方案是，一種剛體空間運動狀態的傅里埃輸出方法，其特征包括以下步驟1、機體軸系三個速度分量輸出為
權利要求
1. 一種剛體空間運動狀態的傅里埃輸出方法，其特征包括以下步驟機體軸系三個速度分量輸出為
全文摘要
本發明公開了一種剛體空間運動狀態的傅里埃輸出方法，該方法通過定義三元數，使得機體軸系三個速度分量和三元數構成線性微分方程組，并采用傅里埃級數對滾轉、俯仰、偏航角速度p，q，r進行近似逼近描述，可以按照任意階保持器的方式求解系統的狀態轉移矩陣，進而得到剛體運動離散狀態方程的表達式，避免了姿態方程奇異問題，從而得到剛體主要運動狀態；本發明通過引入三元數使得狀態轉移矩陣為分塊上三角形式，可以降階求解狀態轉移矩陣，大大簡化了計算復雜度，便于工程使用。
文檔編號G01C21/24GK102359790SQ20111028070
公開日2012年2月22日 申請日期2011年9月20日 優先權日2011年9月20日
發明者史忠科 申請人:西安費斯達自動化工程有限公司
專業數控銑床產品供應商
20年生產經驗，實力工廠，精工品質，質量有保障
