一種姿態(tài)解算算法、裝置及車載慣性導航系統(tǒng)

基本信息

申請?zhí)?/td> CN201911370123.3 申請日 -
公開（公告）號 CN110879066A 公開（公告）日 2020-03-13
申請公布號 CN110879066A 申請公布日 2020-03-13
分類號 G01C21/18;G01C21/34 分類 測量；測試;
發(fā)明人 譚廣藝;張高舉;付迪;劉健 申請（專利權）人 河北美泰電子科技有限公司
代理機構 石家莊國為知識產權事務所 代理人 河北美泰電子科技有限公司
地址 067000 河北省石家莊市昌盛大街21號B10廠房美泰公司
法律狀態(tài) -

摘要

摘要 本發(fā)明適用于導航技術領域，提供了一種姿態(tài)解算算法、裝置及車載慣性導航系統(tǒng)，所述算法包括：獲取載體車輛的速度相關數(shù)據(jù)；根據(jù)所述載體車輛的速度相關數(shù)據(jù)計算當前姿態(tài)更新周期的等效旋轉矢量；根據(jù)所述當前姿態(tài)更新周期的等效旋轉矢量及前一姿態(tài)更新周期的四元數(shù)，計算當前姿態(tài)更新周期的四元數(shù)；利用所述當前姿態(tài)更新周期的四元數(shù)計算所述載體車輛的姿態(tài)角。本發(fā)明提供的姿態(tài)解算算法通過選擇恰當?shù)淖藨B(tài)更新周期可以在保證解算精度的前提下控制計算量。