029惯性传感器测量误差

版权声明:本文系原创文章,没有版权,随意转载,不用告知! https://blog.csdn.net/Pro2015/article/details/83277334

关于讲义《捷联惯导算法与组合导航原理讲义》中“4.2 捷联惯导误差方程”的备忘。

对于陀螺

推导可得到:
(1) ω i b b = [ I + ( μ g × ) + φ g d i a g ( δ k g ) ] ω i b b g ε b = ( I δ K G ) ω i b b g ε b \tag{1} \omega_{ib}^b = [I + (\mu_g ×) + \varphi_g^\vartriangle - diag(\delta k_g)] \omega_{ib}^{b_g} - \varepsilon^b = (I-\delta K_G) \omega_{ib}^{b_g} - \varepsilon^b
其中:
δ K G = [ δ K G x    δ K G y    δ K G z ] = d i a g ( δ k g ) ( μ g × ) φ g = [ δ k g x x μ g z φ g z μ g y φ g y μ g z δ k g y y μ g x φ g x μ g y μ g x δ k g z z ] \delta K_G = [\delta K_{Gx} \space\space \delta K_{Gy} \space\space \delta K_{Gz} ] = diag(\delta k_g) - (\mu_g ×) - \varphi_g^\vartriangle =\begin{bmatrix} \delta k_{gxx} & \mu_{gz}-\varphi_{gz} & -\mu_{gy}-\varphi_{gy} \\ -\mu_{gz} & \delta k_{gyy} & \mu_{gx}-\varphi_{gx} \\ \mu_{gy} & -\mu_{gx} & \delta k_{gzz} \\ \end{bmatrix}

ε b \varepsilon^b 表示陀螺测量零漂。

δ k g , μ g , φ g \delta k_g , \mu_g , \varphi_g 分别为陀螺刻度系数误差、失准角误差和不正交误差, φ g \varphi_g^\vartriangle 表示 φ g \varphi_g 构造的上三角阵。

可以由公式(1)推导得到误差模型:
δ ω i b b = ω i b b g ω i b b δ K G ω i b b + ε b = ω i b x b δ K G x + ω i b y b δ K G y + ω i b z b δ K G z + ε b \delta \omega_{ib}^b =\omega_{ib}^{b_g} - \omega_{ib}^{b} \thickapprox \delta K_G \omega_{ib}^{b} + \varepsilon^b = \omega_{ibx}^b \delta K_{Gx} + \omega_{iby}^b \delta K_{Gy} +\omega_{ibz}^b \delta K_{Gz} + \varepsilon^b

加计同理

仅展示 δ K A \delta K_A

δ K A = [ δ K A x    δ K A y    δ K A z ] = d i a g ( δ k a ) ( μ a × ) φ a = [ δ k a x x μ a z φ a z μ a y φ a y μ a z δ k a y y μ a x φ a x μ a y μ a x δ k a z z ] \delta K_A = [\delta K_{Ax} \space\space \delta K_{Ay} \space\space \delta K_{Az} ] = diag(\delta k_a) - (\mu_a ×) - \varphi_a^\vartriangle =\begin{bmatrix} \delta k_{axx} & \mu_{az}-\varphi_{az} & -\mu_{ay}-\varphi_{ay} \\ -\mu_{az} & \delta k_{ayy} & \mu_{ax}-\varphi_{ax} \\ \mu_{ay} & -\mu_{ax} & \delta k_{azz} \\ \end{bmatrix}

其中:

b \bigtriangledown^b 表示加计测量零偏。

δ k a , μ a , φ a \delta k_a , \mu_a , \varphi_a 分别为加计刻度系数误差、失准角误差和不正交误差, φ a \varphi_a^\vartriangle 表示 φ a \varphi_a 构造的上三角阵。

猜你喜欢

转载自blog.csdn.net/Pro2015/article/details/83277334