分类 算法与数学基础 下的文章

     IMU是一种惯性测量单元。如今,MEMS IMU以其体积小、效率高、成本低等优点被消费者广泛选择。因此MEMS IMU的精度要求会比较高。影响MEMS-IMU精度的主要因素包括确定性误差和随机误差。确定性误差可以通过校准技术消除;对于随机误差,通常采用卡尔曼滤波(Kalman filtering, KF)。然而,KF需要一个特定的滤波模型。MEMS-IMU的随机误差具有弱非线性、非平稳、慢时变等特点,容易受到外界环境等不确定因素的影响。在这种情况下,很难建立精确的误差模型。此时使用KF处理随机误差会导致滤波精度低甚至滤波发散。


    小波变换是80年代发展起来的一种信号分析方法。小波分析适用于非平稳信号,能分析信号的局部特征,能有效地抑制非平稳白噪声中的尖峰噪声。此外,小波分析不需要建立随机误差模型,非常适合于MEMS-IMU信号的降噪处理。常用的小波去噪方法是小波阈值法,传统上可以分为硬阈值法和软阈值法。硬阈值法可以很好地保留突变信号,但硬阈值函数在阈值λj处不连续,使得用估计的小波系数重构信号时产生一定的振荡。软阈值法在阈值λj处是连续的,但估计的小波系数与原始信号的小波系数之间存在恒定的λj偏差,导致重构信号的边缘模糊,影响重构信号的准确性。如果改进的阈值函数在阈值λj处具有良好的连续性,则当小波系数趋于无穷时,估计的小波系数与原始信号的差值趋于零。可以更好地保留原始信号。然而,改进函数中的β系数是不确定的。为了处理不同的信号,需要测试大量不同的beta以适应当前信号,导致灵活性差。


针对上述问题,构造了一种新的无不确定性系数的小波阈值函数,弥补了传统软、硬阈值函数的不足,具有较好的灵活性。实验结果表明,改进后的小波阈值函数能有效降低MEMS-IMU的噪声。该文将介绍传统的小波阈值去噪,改进的小波阈值函数,以及实验结果和分析。


1、传统的小波阈值降噪技术

小波阈值去噪的基本思想最早由斯坦福大学的Dohono提出。该算法简单、计算量小,特别适用于高斯白噪声。其基本思想如下。假设时间信号序列为:

                 

噪声信号经过小波变换后进行分解,有用信号的小波系数值大于噪声信号的小波系数值。一旦在不同尺度上选择合适的阈值,小于预定阈值的小波系数直接归零,大于预定阈值的小波系数保留或减少。然后,利用处理后的小波系数值重构小波信号以抑制噪声;小波去噪方法的主要步骤是过程。


(1)、对噪声信号y进行小波变换,基本公式为:

     

(2)、对小波系数d进行阈值处理。常用的阈值函数有硬阈值函数和软阈值函数。对小波系数进行阈值处理。常用的阈值函数包括硬阈值函数和软阈值函数。

硬阈值函数可以描述为:

                

软阈值函数可以描述为:

                                           


硬阈值函数和软阈值函数函数图分别如图1和图2所示。




    (3)、利用阈值处理后的小波系数d,根据式(2)对信号进行小波逆变换,完成信号的小波重构,得到去噪后的信号。常用的阈值函数虽然简单,

      计算量较小,但也有其缺点。由于硬阈值函数在A处不连续,用处理后的小波系数重构信号时会出现振荡。软阈值函数虽然解决了硬阈值函数中

       的不连续问题,但始终存在恒定的偏差,影响重构精度。


2、改进的小波阈值函数

       针对上述软、硬阈值函数的不足,构造了一种新的小波函数。改进后的小波阈值函数记为:


改进的小波函数图像如图3所示。



从图3可以看出,改进后的小波函数在阈值处是连续的,这使得小波重构后的去噪信号具有更好的平滑性,能够保留原始信号的特征。此外,式(5)中没有不确定系数,去噪更加灵活。



证明了改进小波阈值函数的连续性和偏差不一致性:



3、实验结果与分析


通过MEMS-IMU测量数据实验,验证了改进方法对MEMS-IMU输出信号的去噪效果。


实验条件如下:


将MEMS-IMU设置为静态,陀螺仪恒定偏差设置为0.2。/h,陀螺仪随机白噪声设置为10。/h标准差(SD)。加速度计恒偏置设置为5u 10 ~ 3g,加速度计随机白噪声设置为10 ~ 2g SD。输出频率为10 Hz,实验时间为60 s。

陀螺仪和加速度计的原始信号如图4和图5所示。不同方法对陀螺仪和加速度计的去噪结果如图6和7所示。




对每种方法的原始信号的SD信号和去噪信号进行统计排序。结果如下表所示。


从图4到图7和表1可以看出,采用硬阈值去噪方法,重构信号容易出现振荡。对于软阈值去噪方法,重构信号精度不高,信号不平滑。改进的小波阈值去噪方法,重构信号平滑,SD值小于软、硬阈值,充分说明改进的方法比软、硬阈值去噪效果更好。


4、结论

构造的小波阈值函数克服了硬阈值函数不连续导致的重构信号振荡问题,也解决了软阈值函数的恒定偏差问题。该方法可以有效抑制MEMS-IMU信号中的随机误差,降低信号中的噪声。



    MEMS (Micro Electro Mechanical System)惯性传感器的出现和快速发展推动着惯性导航系统的小型化。MEMS惯性技术和微机电导航系统在国防和军事中的战略战术价值和意义日益突出。

    MIMU是惯性系统中的关键单元,其精度在很大程度上决定了系统的性能。然而,输出信号通常是有噪声的、非平稳的,并且包括实验环境等影响。因此,需要对MIMU单元获得的陀螺仪和加速度计的输出信号进行去噪处理,以提高MIMU的输出精度。本文主要研究MEMS-IMU信号的去噪技术,采用三种不同的方法:中值平均法IIR数字滤波法小波去噪技术来去除MIMU输出信号中的噪声。通过对处理结果的对比研究,证实了小波变换在信号去噪处理中的适用性和优越性,提高了MIMU的输出精度。这提高了惯性导航系统的性能。


一、传统的滤波与降噪方法

   1、中值、均值滤波

         中值均值滤波算法公式如下:

         

     下面的数据为MEMS-IMU静态条件下1000s的数据,实际采样频率为50Hz。在实验中,该数据在10个采样点上进行平滑处理。

      处理结果如下图所示。   从图中可以看出,处理后的信号比较平滑。


                                            中值平均处理前后陀螺仪和加速度计信号的比较


     2、IIR 滤波

         数字滤波器分为IIR (infinite impulse response filter)和FIR (finite impulse response filter)。IIR滤波器具有零点,

       能以较小的阶数达到较好的滤波效果,计算量较小。较小,故采用IIR滤波器设计。由于微机械器件的频带较窄,而巴特沃斯

       低通滤波器在低频具有最大的平坦性,因此考虑采用巴特沃斯低通滤波器。


    2.1 频谱分析

       以下数据为导航计算机采集的陀螺仪和加速度计的输出信号经过快速傅里叶变换后的频谱图.

      

                                                         陀螺仪和加速度计信号频谱图

            观察它们的频谱图,如上图所示,可以看出陀螺仪的高频干扰噪声非常大,几乎等于有用低频信号的幅值;


     2.2 数字滤波器设计

       设计IIR滤波器通常包括首先设计模拟滤波器,然后将模拟滤波器转换为数字滤波器。仿真巴特沃斯滤波器的幅频平方特性

       函数为:

      

        模拟系统的传递函数与频率响应由s=j Ω联系起来,因此其归一化低通滤波器的传递函数Hn (s)为:


         模拟滤波器的设计步骤如下:

         (1): 给定通带Ω1和阻带频率Ω2,对应的衰减系数ap和as;

         (2): 根据下面的公式找到滤波器的阶数N;

        

        从下面的公式中求截止频率Ωc;

          

          根据上述方法得到滤波器阶数N和截止频率Ωc,从而得到模拟滤波器的传递函数Hn (s),通过双线性映射将模拟滤波器转换为

      数字滤波器。考虑到总体要求,系统要求设计一个数字低通滤波器,其技术指标为:fp=10Hz, fs=30Hz, ap=4dB, as=20dB,采样频率fs= 50Hz。代入设计公式,可得滤波器阶数N=5。使用这个滤波器对原始信号进行滤波。滤波后的信号频谱和信号图如图

     3.3所示。从图中可以看出,信号中的高频噪声明显降低。

IIR数字滤波前后陀螺仪和加速度计信号比较




      3、Savitsky-Golay 滤波



二、小波变换滤波

   1、滤波原理

        小波变换理论是20世纪80年代末发展起来的一个应用数学分支。它是一种信号的时频分析方法,具有多分辨率分析的特点,

   同时具有表征信号在时域和频域局部特征的能力。它是一个大小固定但形状可以改变的窗口。时间窗,它是一种时频局域化分析

   方法,其频域窗口可以改变,因此被称为信号分析显微镜。

Mallet受图像分解与重构的tower算法的启发,提出了一种基于多分辨率理论的小波分解与重构快速算法——Mallet算法。该算法在小波变换中的地位与FFT在傅里叶变换中的地位相当。位置。

  2、信号分解

     Mallat算法,又称塔算法,利用小波滤波器H0、H1和G0、G1对信号进行分解重构。分解算法如下:

其中,t为离散时间序号,f(t)为原始信号;j是层数,H0和H1是时域的小波分解滤波器,Aj是第j层信号f(t)的近似部分。小波系数,Dj为第j层信号f(t)细节部分的小波系数。假设离散信号f(t)为A0,信号f(t)位于2j尺度的近似部分,即低频部分的小波系数为2j-1尺度近似部分的小波系数Aj-1与分解滤波器H1卷积,然后对卷积结果进行间隔采样,得到信号f(t)在2j尺度上的细节部分,即高频部分的小波系数Dj是小波系数Aj-1通过2j-1尺度与分解滤波器H0卷积的近似部分,每隔一点采样得到卷积结果。通过分解,在每个尺度2j,将信号f(t)分解为近似部分的小波系数Aj(低频子带)和细节部分的小波系数Dj(高频子带)。小波分解算法如下图所示。



小波分解算法原理图


    2、信号重构

       重建算法如下:

        

在上式中,G0和G1是时域的小波重构滤波器。低频部分的小波系数Aj通过每隔一点插零后的2j+1尺度近似部分的小波系数Aj+1与重构滤波器G0进行卷积,2j+1尺度的细节部分的小波系数每隔一点插零。对重建滤波器G1进行卷积,然后求和。此过程重复到第20个尺度,以获得重构信号。小波重构算法如下图所示。


小波重构算法原理图


   3、信号的小波形分析与去噪

      利用小波分析算法对信号去噪的过程是:首先对信号进行小波分解,然后对小波分解后的系数以阈值域值的形式进行处理;然后对信号进行小波重构,从而达到消除噪声的目的。一般来说,随着变换尺度的增大,分辨率越来越高,滤波效果也越来越好。但在实际应用中,必须考虑计算量和计算舍入误差等因素,因此需要根据实际精度要求和各种影响因素来确定所需的小波变换尺度。在比较不同小波基和不同分解层的效果的基础上,选择5层Debauches2小波对信号进行处理。



总结:

    三种不同的方法:中值平均法、IIR数字滤波法和小波变换法对MIMU输出信号的噪声去除都有一定的效果。其中,中位数平均法最简单,滤波时间最短,是一种比较常用的方法。但当MIMU输出高动态信号时,该方法不能使用,必须使用IIR数字滤波方法或小波去噪方法进行去噪。数字滤波的时间相对较短,而小波去噪方法需要对信号进行分解和重构,耗时较长,但小波去噪的精度高于数字滤波。因此,当我们使用高性能硬件时,可以用较少的分解层数实现小波变换进行去噪,从而在一定程度上提高惯导精度。



1、地球几何模型


2、坐标系

    GPS/GNSS输出的定位结果是基于: 地心地固坐标系(ECEF)

     IMU测量的是载体坐标系(IMU坐标系设为载体坐标系)与惯性坐标系(地表导航通常选择ECI)的相对旋转关系

     建立惯性坐标系必须以相对惯性空间静止或匀速运动的物体为参照物,实际这样的物体是不存在的,因此只能

    建立近似的惯性系。在捷联惯性导航系统中通常使用太阳中心惯性坐标系为惯性坐标系,一般载体在地球的附近运动,

    也可使用地心惯性坐标系。

    捷联惯导系统中陀螺仪和加速度计的测量输出均以惯性坐标系为基准,即IMU测量结果是IMU坐标系相对惯性坐标系的相对值。


3、科里奥利加速度和科里奥利力

     在捷联惯导系统中,加速度计测量的载体加速度沿载体坐标系的轴向,必须将加速
   度计的输出分解到导航坐标系,才能进行导航解算


4、重力与万有引力的区别


5、IMU测量误差模型

     MEMS IMU误差组成: 确定性误差 + 随机误差

    5.1、 磁力计标定

             matlab函数:  magcal


    5.2、加速度计标定

              matlab函数: accelcal     


6、旋转、转动微分方程(四元数、旋转矩阵、旋转矢量)


7、数值积分方法(欧拉积分法、龙格库塔积分法)


8、ESKF


9、杆臂效应补偿