復雜磁擾動場景MEMS電子羅盤的動態(tài)方位角解算方法

基本信息

申請?zhí)?/td> CN201911310478.3 申請日 -
公開（公告）號 CN111272158B 公開（公告）日 2021-12-31
申請公布號 CN111272158B 申請公布日 2021-12-31
分類號 G01C17/38 分類 測量；測試;
發(fā)明人 葉景成;時廣軼;王春波;徐開明;吳志剛;金玉豐 申請（專利權(quán)）人 無錫北微傳感科技有限公司
代理機構(gòu) 北京商專潤文專利代理事務(wù)所（普通合伙） 代理人 邢若蘭
地址 214000 江蘇省無錫市濱湖區(qū)繡溪路58-30
法律狀態(tài) -

摘要

摘要 本發(fā)明公開了復雜磁擾動場景MEMS電子羅盤的動態(tài)方位角解算方法，包括：獲取多冗余傳感器中加速度計、磁力計和陀螺儀的輸出值；判斷是否需要進行濾波；若需要進行濾波，構(gòu)建擴展卡爾曼濾波器，輸出加速度計、磁力計和陀螺儀的輸出值的最優(yōu)估值；若不需要進行濾波，直接輸出多冗余傳感器中加速度計、磁力計和陀螺儀的輸出值；分別用傾角補償算法、磁場比例角補償算法和陀螺儀Z軸積分算法解算方位角；根據(jù)載體當前運動姿態(tài)進行數(shù)據(jù)融合，得到最優(yōu)方位角。本發(fā)明提供的復雜磁擾動場景MEMS電子羅盤的動態(tài)方位角解算方法，使MEMS電子羅盤在磁擾動和動態(tài)條件下，自適應(yīng)完成準確的方位角解算，提高定向精度；算法結(jié)構(gòu)簡單，收斂速度快。