惯组IMU各种噪声参数的理解、设计导航系统示例

我只是知识的搬运工，在理解之后加以整合，最大程度降低谬误。

零偏（Bias）：可以理解为是输出减掉输入，一般指均值”：零偏的定义是传感器输出与标准输入之间的差值，零偏=实测陀螺数据-真值（≠均值），一般MEMS陀螺（高精度不可）使用短期静态下零输入时的输出均值近似表达静态下的零偏值，动态下零偏需要在转台上使用标准速率输入进行标定拟合。

零偏稳定性（Bias stability，In-Run Bias Stability）：衡量在一次上电过程中，零偏的变化，单位大多为°/h。是陀螺最为重要的指标，工程上常用一段时间采样平均值的标准差来衡量。但是平滑时间是不固定的，如果是光纤陀螺，平滑时间通常为10s，如果是激光陀螺，平滑时间通常为100s（注1），MEMS的平滑时间为10s。它体现的是陀螺仪的综合性能。

零偏不稳定性（Bias instability）：单位大多为°/h，这个参数是用Allan方差计算的，是Allan方差的最低点，与陀螺的零偏稳定性单位相同，但是二者的数值没有固定的关系。

零偏重复性（Run-Run Bias Stability）：单位大多为°/h，是衡量每一次陀螺上电的零偏的变化，测试时注意每一次上电之间的间隔要大一些，10-20min比较稳妥。

角度随机游走（Angular random walk，ARW）：利用Allan方差来计算，单位为°/√h。工程上可以理解为衡量陀螺白噪声方差的一个量，二者有一定的换算关系。

速率噪声密度（Rate Noise Density，RND）: 利用Allan方差来计算，单位为°/sec/√Hz。工程上可以理解为衡量陀螺白噪声方差的一个量，与角度随机游走相同二者有一定的换算关系。

角速度随机游走（Rate Random Walk，RRW）：利用Allan方差来计算，单位为 °/ (h)^1.5。陀螺的角速率输出随着时间缓慢变化，通常由系统误差引起，比如环境温度的缓慢变化。可以用来衡量零偏的变化规律。

一般的陀螺仪也不会给出角速度随机游走，其实可以暂时不用考虑这一项。重点是除了角速度的白噪声之外，考虑bias 不稳定性，可以通过跟踪bias的方法去对噪声进行估计。

那么怎么从零偏稳定性到零偏不稳定性呢？真的需要这个准确的量吗？应该理论上来说这些参量都是用来评价陀螺仪的性能的，并不需要直接使用这些数值进行设计惯导系统。并且在实际系统中，这些理论值只能作为调参数的参考值。

陀螺的随机噪声里包含零偏不稳定导致的低频噪声，高频白噪声（导致角度随机游走），以及角加速度白噪声导致的角速率随机游走噪声，只需要考虑这三个噪声量即可。

因此一个陀螺的噪声通常可以简化成为如下

Ω

(

t

)

=

Ω

Ideal

(

t

)

+

Bias

?

N

(

t

)

+

Bias

?

B

(

t

)

+

Bias

?

K

(

t

)

\Omega(t)=\Omega_{\text {Ideal}}(t)+\operatorname{Bias}_{N}(t)+\operatorname{Bias}_{B}(t)+\operatorname{Bias}_{K}(t)

Ω(t)=ΩIdeal?(t)+BiasN?(t)+BiasB?(t)+BiasK?(t)

使用长时间静止的陀螺仪数据对陀螺仪噪声参数进行分析，上式中，三个噪声参数N（角度随机游走）（备注：角速度的白噪声，积分出来的角度就是随机游走），K（速率随机游走）和B（bias不稳定性）（或者叫零偏不稳定性）。他们的单位分别如下，都可以通过Allan方法标定。

零偏稳定性是陀螺给出的参数，但是零偏不稳定性是可以标定出来的值，这是两个的重要区别。

这里的噪声参数都是标准差的形式，并且都是针对于连续信号。那么在对信号进行采样时，会有采样率fs、采样间隔1/fs。将信号离散化，信号的噪声的功率（标准差）也会发生变化。参考1，两者有如下关系：

因此也可以表示为：

a

^

[

k

]

=

a

[

k

]

+

σ

a

1

Δ

t

w

[

k

]

+

b

d

b

a

[

k

?

1

]

+

σ

b

a

Δ

t

w

[

k

]

g

^

[

k

]

=

g

[

k

]

+

σ

g

1

Δ

t

w

[

k

]

+

b

d

b

g

[

k

?

1

]

+

σ

b

g

Δ

t

w

[

k

]

\begin{array}{l} \hat{\mathbf{a}}[k]=\mathbf{a}[k]+\boldsymbol{\sigma}_{a} \frac{1}{\sqrt{\Delta t}} \mathbf{w}[k]+\mathbf{b}_{d b a}[k-1]+\boldsymbol{\sigma}_{b a} \sqrt{\Delta t} \mathbf{w}[k] \\ \hat{\mathbf{g}}[k]=\mathbf{g}[k]+\boldsymbol{\sigma}_{g} \frac{1}{\sqrt{\Delta t}} \mathbf{w}[k]+\mathbf{b}_{d b g}[k-1]+\boldsymbol{\sigma}_{b g} \sqrt{\Delta t} \mathbf{w}[k] \end{array}

a^[k]=a[k]+σa?Δt ?1?w[k]+bdba?[k?1]+σba?Δt ?w[k]g^?[k]=g[k]+σg?Δt ?1?w[k]+bdbg?[k?1]+σbg?Δt ?w[k]? 下面以随机游走噪声为例：（白噪声相类似）

因此，随机游走噪声的分析得分两个过程：

allan方差标定很简洁有效，但是没办法标定出常值偏差。具体加噪见代码，可以直接标定出三个重要的量，单位是deg/s。

下面的噪声只有白噪声和角速度随机游走，但是在标定中依然可以标定出bias不稳定性。（斜率为0的曲线）

那么这是为什么呢？

零偏不稳定性误差是一种介于高斯白噪声和维纳过程之间的噪声，它的功率谱密度和 1/f成正比。这种噪声是由某些电子原件的特性造成的，是一种物理上存在的噪声，并且在极低频率下通过测量仍然满足和1/f成正比的特性。

零偏不稳定性是一种非静态噪声，可以理解为高斯白噪声和维纳过程的混合。直观上理解，零偏不稳定性误差会使陀螺仪和加速度计的零偏随时间慢慢变化，逐渐偏离开机时校准的零偏误差；同时还会造成一部分随机行走误差的效果。陀螺仪零偏不稳定性误差的单位一般是 deg/h ，加速度计一般是 。文献 [3] 和网络上的一种说法是它表示在一段时间内零偏的变化量，但这种理解在理论上并不准确，而且一般厂商也不会说明“一段时间”究竟是多久。

另外下面一段话解决了相应的困惑：

那么实际情况下，零偏不稳定性和角速度随机游走角度随机游走这些量都混合到了一起，所以标定时还是可以看到“零偏不稳定”的结果。

下面就是设计卡尔曼滤波系统，主要参考链接。

其中P是随意的，观测协方差矩阵R也是和观测噪声相关比较直观。需要确定的就是过程协方差Q矩阵。这里的卡尔曼滤波器只考虑角度随机游走，（也就是角速度的高斯白噪声）。那么怎么确定相应的Q矩阵呢？

角度随机游走可以理解为白噪声关于时间的积分。关键理解三个点就可以了：

1，BQB^T 是状态的方差在 dt 时间内增量；

2，随机游走的方差增量和时间增量成正比，是 sigma^2*dt；

3，sigma 的单位是 deg/sqrt(sec)。剩下的你分析下量纲就知道了。晕的原因是 dt 这项包含在 B 里面了，所以方差要放缩一下。

那么也就是说Q可以表示为：sigma^2/dt * (W*dt) *(W*dt)。

那么系统如果只考虑陀螺仪数据的白噪声项，那么参考博客的结果。

[外链图片转存失败,源站可能有防盗链机制,建议将图片保存下来直接上传(img-5fqMmpti-1604496120025)(pic/image-20201104152045751.png)]

这里可以看出是对噪声进行求导？获得雅可比矩阵？得到结论：不是对角速度进行微分求导雅可比矩阵，而是对噪声进行求导计算雅可比矩阵。这点很重要。

手推VIO ??