1.一種九軸傳感器的誤差參數(shù)標定方法，其特征在于，包括如下步驟：

步驟1，以九軸傳感器的測量中心為旋轉(zhuǎn)中心，使其繞著傳感器坐標系的X、Y、Z三軸分別旋轉(zhuǎn)多圈；

步驟2，建立九軸傳感器中陀螺儀、加速度計、磁力計的測量模型，確定需要標定的參數(shù)；

步驟3，使用捷聯(lián)慣導算法解算九軸傳感器在標定過程中各個時刻的位置、速度及姿態(tài)，結(jié)合當?shù)刈鴺讼迪麓艌鰪姸扰c磁力計原始觀測值的關(guān)系，構(gòu)建卡爾曼濾波器中的系統(tǒng)誤差狀態(tài)方程；

步驟3的實現(xiàn)方式包括以下子步驟，

31)慣導算法和磁場預測算法建立系統(tǒng)狀態(tài)方程

其中，由于MEMS九軸傳感器器件精度低，地球自轉(zhuǎn)對捷聯(lián)慣導推算造成的誤差影響很小，故慣導算法中不考慮地球自轉(zhuǎn)，慣導算法和磁場預測算法具體如下：

式中，上標n表示當?shù)刈鴺薾系，n系是以慣性傳感器IMU相位中心為原點，x軸平行于當?shù)厮矫嬷赶蛘保瑈軸平行于當?shù)厮矫嬷赶蛘龞|，z軸垂直于當?shù)厮矫嫦蛳拢邩?gòu)成右手系；k表示第k個歷元；為第k個歷元時n系下的位置向量；為第k個歷元時n系下的速度向量；為第k個歷元時b系到n系的方向余弦轉(zhuǎn)換矩陣；為第k個歷元時磁場強度在n系的投影；表示第k個歷元加速度計的原始輸出；gⁿ表示重力加速度在n系下的投影向量；Δt＝t_k-t_k-1為第k-1個第k個觀測歷元的時間間隔；表示第k個歷元陀螺儀計的原始輸出；為磁力計傳感器觀測坐標系到IMU傳感器坐標系的轉(zhuǎn)換矩陣；為第k個歷元時磁力計原始輸出；b_m為磁力計零偏；(·×)為向量叉乘形式；

32)建立離散時間系統(tǒng)誤差狀態(tài)微分方程

卡爾曼濾波的狀態(tài)向量包含導航誤差狀態(tài)和傳感器誤差，30維的連續(xù)誤差狀態(tài)向量定義如下：

式中，δx表示狀態(tài)向量誤差；δrⁿ、δvⁿ、Ψ分別為n系下位置誤差、速度誤差和姿態(tài)誤差向量；δb_g、δb_a、δb_m分別為陀螺、加速度計、磁力計的零偏誤差向量；δS_g、δS_a分別為陀螺、加速度計比例因子誤差向量；為b系到m系的轉(zhuǎn)換矩陣誤差；δmⁿ表示估計的n系磁場強度分量誤差；δx中各個分量均為時間的函數(shù)，為方便書寫，省略了時間變量t的書寫，離散后的系統(tǒng)誤差模型表示如下：

δx_k＝Φ_k/k-1δx_k-1/k-1+Γ_k-1w_k-1 (6)

式中，下標k-1和k分別表示時刻t_k-1和t_k；Φ_k/k-1表示t_k-1到t_k時刻的狀態(tài)一步轉(zhuǎn)移矩陣；Γ_k-1為系統(tǒng)噪聲驅(qū)動陣；w_k-1為系統(tǒng)激勵噪聲；

為得到離散后的系統(tǒng)誤差模型，首先需要得到δx的連續(xù)時間微分方程，具體形式為：

式中，表示各個誤差狀態(tài)向量的微分方程；F(t)為各個狀態(tài)向量誤差微分方程的系數(shù)矩陣；G(t)為驅(qū)動噪聲系數(shù)矩陣；w(t)為各個狀態(tài)向量誤差的驅(qū)動噪聲；

各個系統(tǒng)誤差狀態(tài)微分方程如下：

式中，分別表示n系下位置誤差、速度誤差和姿態(tài)誤差、陀螺儀零偏誤差、加速度計零偏誤差、陀螺儀比例因子誤差、加速度計比例因子誤差、磁力計零偏誤差、磁力計轉(zhuǎn)換矩陣誤差、n系磁場強度分量誤差的微分方程；δrⁿ、δvⁿ、Ψ分別為n系下位置誤差、速度誤差和姿態(tài)誤差向量；δb_g、δb_a、b_m分別為陀螺、加速度計、磁力計的零偏誤差向量；δS_g、δS_a分別為陀螺、加速度計比例因子誤差向量；為b系到m系的轉(zhuǎn)換矩陣誤差；δmⁿ表示估計的n系磁場強度分量誤差；w_a為加速度計傳感器噪聲，為高斯白噪聲；w_g為陀螺儀傳感器噪聲，為高斯白噪聲；τ_bg、τ_ba、τ_sg、τ_sa分別為陀螺儀零偏相關(guān)時間、加速度計零偏相關(guān)時間、陀螺比例因子相關(guān)時間、加速度計比例因子相關(guān)時間；w_bg、w_ba、w_sg、w_sa分別為陀螺儀零偏驅(qū)動白噪聲、加速度計零偏驅(qū)動白噪聲、陀螺比例因子驅(qū)動白噪聲、加速度計比例因子驅(qū)動白噪聲；

33)構(gòu)建誤差狀態(tài)的系統(tǒng)誤差狀態(tài)方程

根據(jù)32)中得到的系統(tǒng)誤差狀態(tài)微分方程，得到系統(tǒng)誤差狀態(tài)方程的一步轉(zhuǎn)移矩陣，即δx_k＝Φ_k/k-1δx_k-1/k-1+Γ_k-1w_k-1中的Φ_k/k-1；

Φ_k/k-1＝exp{F(t_k-1)Δt}≈I+F(t_k)Δt (9)

式中，I為單位陣，至此，卡爾曼濾波器的系統(tǒng)誤差狀態(tài)方程建立完成；誤差狀態(tài)向量每次濾波反饋后都需要進行置零處理，因此不對誤差狀態(tài)向量預測，只對誤差狀態(tài)量的協(xié)方差進行預測；

步驟4，標定過程中，基于位置不變和單一位置下環(huán)境磁場不變的假設(shè)，構(gòu)建卡爾曼濾波器的量測方程，完成傳感器誤差參數(shù)標定。