028捷聯慣導更新演算法備忘
1、姿態更新
對於 n及 b系,假定有如下四元數轉換關係:
那麼:
rn(k+1)=Cb(k+1)n(k+1)rb(k+1)=Cn(k)n(k+1)Cn(k)b(k)Cb(k)n(k)Cb(k+1)b(k)rb(k+1)
等價於:
rn(k+1)=Q(tk+1)⊗rb(k+1)⊗Q∗(tk+1)=p∗(h)⊗{Q(tk)⊗[q(h)⊗rb(k+1)⊗q∗(h)]⊗Q∗(tk)}⊗p(h)=[p∗(h)⊗Q(tk)⊗q(h)]⊗rb(k+1)⊗[q∗(h)⊗Q∗(tk)⊗p(h)]
所以:
Q(tk+1)=p∗(h)⊗Q(tk)⊗q(h)
其中: p∗(h) 由 −ωinn確定, q(h)由圓錐誤差補償後的等效旋轉向量確定。
等效旋轉向量的求解,就是求解旋轉向量微分方程(Bortz方程),該方程通過n子樣演算法求解。為了使旋轉向量準確,還要在子樣演算法求解旋轉向量中對其進行圓錐運動的不可交換誤差補償。
2、速度更新
速度更新需要計算三部分的內容,即前一時刻速度、比力引起的速度補償、有害加速度引起的速度補償。計算的重點是比力引起的速度補償。該部分包含加計輸出的速度增量、速度的旋轉效應補償以及速度的划槳效應補償。另外速度的划槳效應補償還應對其進行優化,方法及係數同等效旋轉向量的不可交換誤差補償優化。最後還要把比力引起的速度補償從b系轉換到n系進行速度的更新。
秦書中的姿態和速度更新沒有將 Cn(k)n(k+1)計算在內,而是事後進行了補償,嚴講義中將 Cn(k)n(k+1)直接計算在內。
3、位置更新
略
相關推薦
028捷聯慣導更新演算法備忘
1、姿態更新 對於 n n n及
035捷聯慣導中三種姿態更新演算法說明
看到了不同的姿態更新演算法,很迷惑,陷入了誰相對於誰的思考中。翻翻嚴老師部落格,貼出來如下: 原文地址:http://blog.sina.com.cn/s/blog_40edfdc90102v6il.html#cmt_556E9C77-7F000001-41D46DB9-790-8
基於四元素法的捷聯慣導姿態更新演算法
旋轉向量法根據運載體角速度擬合方式,分為單子樣演算法(常數擬合),二子樣演算法(直線擬合),三子樣演算法(拋物線擬合)。因此可以根據需要採用合適的多子樣演算法實現對不可交換誤差做有效補償。旋轉向量法精度通常優於四元素法,但是通常計算量較四元素法更大,其較四元素法更適合角機動頻繁或者存在嚴重角振
捷聯慣導中的姿態更新
捷聯式慣導的特點:依靠演算法建立導航座標系,省略複雜的物理平臺,結構簡單,體積小,重量輕,成本低,維護簡便,可靠性高,還可通過餘度技術提高容錯能力。 姿態更新演算法對比 姿態更新演算法 原理 優點 缺點 尤拉角法 通過求解尤拉角微分方程直接計算航向角、俯仰角和橫滾角 簡單明
021靜態慣性器件捷聯慣導模擬(3).md
主函式 %捷聯慣導模擬主程式 %東北天座標系,東X北Y天Z clear clc glvs; % 載入全域性變數 % 子樣數和取樣時間 nn = 2; % 子樣數,下面也將採用二子樣的圓錐誤差補償演算法 ts = 0.1;
捷聯慣導系統模型及模擬(二)
1.2 姿態誤差模型 姿態誤差模型,是研究的重點。 一種新的對準方法,的新意就主要集中於姿態誤差模型的不同。 例如: 從源頭上就分成了,慣性系下 和 地理座標系下的對準;(本文先分析後者) 然
捷聯慣導系統模型及模擬
1.誤差模型 1.1 速度誤差模型 引用秦書P311 不考慮誤差,速度的理想值可以從下面的微分方程解得: V˙n=Cnbfb−(2ωnie+ωnen)×Vn+gn(1)(1)V˙n=
加密演算法備忘
網上加密演算法的文章很多,但是剛好沒有辦法滿足自己的需求,只好再挖一坑。。。 內容比較淺顯,大神勿看。 RSA加密演算法 - 將兩個大素數相乘的乘積公開作為加密金鑰,因為對其進行因式分解極其困難;由 RSA 公司發明,是一個支援變長金鑰的公共金鑰演算法,需要加密的檔案塊的長度
捷聯導航演算法
捷聯式慣性導航是把與機體固連的慣性器件所測量的飛行器的運動資訊經過計算機處理成所需要導航與控制資訊,而姿態矩陣的更新是捷聯式慣導演算法中最重要的一部分,也是捷聯絡統所固有的。 在捷聯式慣導中,飛行器的姿態是機體座標系相對於導航座標系決定的,而描述座標系的方
Laravel之備忘項(不定期更新)
自定義字段 ida 不定 blog red color request validate 打印sql 1.自定義字段驗證錯誤信息 $this->validate($request, [‘name‘ => ‘required|max:5
向量求導幾則公式備忘
ima -s png mage str span 技術分享 -1 strong 向量求導幾則公式備忘 向量
關於數據的級聯刪除和更新
TP table 資料 clu 通過 兩張 之間 microsoft 關聯 很多時候,我們會碰到這樣的場景:“刪除一個表的數據的時候,將另一個表的相關數據刪除。” 在這裏我建立兩張表:“ProductCategory”,“Product”. 有一個需求是這樣的:在刪除
整理備忘一波liunx命令(持續更新)
監聽 使用 掛載 mysqld IV lan netstat命令 所有 gre # 分區掛載 # 文件操作 # 編輯操作 # 網洛端口 netstat命令各個參數說明如下: -t : 指明顯示TCP端口 -u : 指明顯示U
laravel常用備忘,定期更新
mem from stat () member user AI ember ber $handle->orWhereRaw(‘((bbs_title.icm_type = 2 or bbs_title.icm_role_type =2))‘); $handle->
基於ROS獲取Android影象和慣導資料
0 將手機與ROS連線 首先,通過區域網將手機與ROS相連線。我使用的是hitcm部落格的程式,具體可以參考他的部落格。到這一步已經可以在電腦端做進一步的計算了,但是如果還想記錄下來資料以便未來再次回放使用,則需要進一步處理。 1 記錄bag ROS與手機相連後,使用rosbag命令開始記錄資料:
ROS慣導資料釋出(Python)
一、背景 基本配置:ubuntu 16.04,ROS Kinetic 慣導型號:維特智慧 WT61C(六軸慣導) 維特智慧官方提供的參考程式是通過手動比較各個位元組來確定資料包/資料幀的,個人認為比較繁瑣,因此採用Python的re(正則表示式)和struct(位元組處理)模組簡化其資料匹配
ROS慣導數據發布(Python)
ces pan rom 協方差 lis success ack __name__ http 一、背景 基本配置:ubuntu 16.04,ROS Kinetic 慣導型號:維特智能 WT61C(六軸慣導) 維特智能官方提供的參考程序是通過手動比較各個字節來確定數
慣導IMU和慣導INS
位置定位和姿態測量除了全球GPS定位這個系統,還有就是慣導系統。 這裡簡單介紹一下關於慣導的一些進本原理和所用的地方以及imu與ins的區別。 慣性導航 通過測量飛行器的加速度,並自動進行積分運算獲得飛行器瞬時速度和瞬時位置資料的技術。組成慣性導航系統的裝置都安裝在運載
032一組慣導參考資料
翻看嚴恭敏老師的部落格發現一組實測慣導資料,特地下載下來用其工具箱處理了一下,肉眼看起來跟原圖沒有差別。到這算是終於有了一組珍貴的資料(實測資料,又有處理好的結果作參考)。一組資料可以做很多事,比如作為驗證自己目前程式的資料。哈哈,收穫不小,不敢獨享,特來分享。注意,我貼出來的資料是
030低成本車載MEMS慣導導航定位方法
[1]李博文,姚丹亞. 低成本車載MEMS慣導導航定位方法[J]. 中國慣性技術學報,2014,22(06):719-723. 下載地址 提取碼:e83m 1、主要內容: 對純慣導的導航資料處理方法進行了改進。 2、方法: (1)認為載體總是在做圓周運動; (2)在對慣