一种基于改进AR模型和平滑滤波的陀螺误差抑制方法
文献发布时间:2023-06-19 19:30:30
技术领域
本发明属于水下机器人陀螺仪误差补偿技术领域,具体涉及一种基于改进AR模型和平滑滤波的陀螺误差抑制方法。
背景技术
水下机器人作为水下作业的重要载体,因其体积小,灵活度高,在海洋资源勘测、水下设备检测等领域发挥着重要作用。水下机器人在水下作业需要时刻获得自身的位置和姿态信息。近年来小型低成本的水下机器人运用越来越普遍,相对应的需要一种小型低成本的惯性器件为机器人提供位姿信息。随着微机电系统的快速发展,基于微机电系统的水下导航传感器也应运而生,微机械惯性测量单元(MEMS IMU)具有体积小、成本低等优点,但是相对而言,其随机误差较大。
水下环境相较于地面更为复杂,因此水下机器人在水下航行时会出现由于剧烈晃动及陀螺受到随机扰动而导致误差补偿能力下降问题。
发明内容
针对上述问题,本发明提出一种基于改进AR模型和平滑滤波的陀螺误差抑制方法。首先,为提高陀螺仪角速度信息的抗干扰能力,提出一种滑动窗拉盖尔多项式抗差拟合处理方法,使用此方法对陀螺数据进行预处理,去除掉扰动项;其次,为提高水下机器人航行过程中陀螺输出的信息的稳定性性,本发明将滑动窗算法引入改进AR模型中,提高陀螺仪输出数据剧烈波动情况下对误差精确建模的能力;最后,本发明给出一种基于后向平滑卡尔曼滤波的误差抑制方法。
为达到上述目的,本发明的技术方案如下:
一种基于改进AR模型和平滑滤波的陀螺误差抑制方法,该方法基于已知量MEMSIMU陀螺输出的设备系下的三维角速度信息
(1)采用滑动窗3阶拉盖尔多项式抗差拟合处理方法对陀螺输出信息进行抗差处理;
(2)使用步骤(1)得到的陀螺角速度信息建立改进的实时AR模型;
(3)使用以IGGIII法为权函数的抗差最小二乘估计参数;
(4)后向平滑卡尔曼滤波补偿。
进一步地,步骤(1)的具体方法是:
设置滑动窗口长度为N=10,当陀螺采样个数,即N<10时不做处理,当N≥10时分别对陀螺的测量信息处理如下:
其中,
经过该抗差处理后可得到一系列序列号为
其中,
进一步地,步骤(2)的具体方法是:
设置窗口长度N=20的滑动窗,首先对每一个滑动窗取均值为:
其中
随后建立改进的AR模型如下:
其中
其中
进一步地,步骤(3)的具体方法是:
使用以IGGIII法为权函数的抗差最小二乘估计,IGGIII法的权因子为:
其中
。
进一步地,步骤(4)的具体方法是:
卡尔曼滤波过程如下:
系统的状态方程为:
其中
其中
其中
下面进入后向平滑过程更新
其中
将所得
与现有技术相比,本发明具有如下优点:
(1) 本发明针对水下航行器陀螺仪输出角速度信息受水下环境干扰而易产生非正常扰动项的问题,引入拉盖尔多项式对陀螺信息进行预处理,提出一种滑动窗3阶拉盖尔多项式抗差拟合处理方法,进一步提高了水下航行器装载的陀螺仪测量角速度的抗干扰能力。
(2) 本发明针对水下航行器行驶时容易剧烈晃动而使陀螺输出信息波动的问题,本发明引入滑动窗改进AR模型,通过滑动窗减小陀螺输出波动影响,进一步提高了陀螺误差建模的准确性。
(3) 本发明针对传统卡尔曼滤波利用上一时刻的状态量递推当前时刻的状态时,上一时刻的状态估计对当前时刻状态估计精度影响很大的问题,本发明引入后向平滑滤波算法,对当前时刻的估计结果进行递归计算,提高了误差补偿精度。
附图说明
图1为本发明所描述的基于改进AR模型和平滑滤波的陀螺误差抑制方法流程图;
图2实验车辆运动轨迹曲线;
图3不同方法的位置误差曲线。
具体实施方式
下面结合附图和具体实施方式,进一步阐明本发明,应理解下述具体实施方式仅用于说明本发明而不用于限制本发明的范围。
一种基于改进AR模型和平滑滤波的陀螺误差抑制方法,该方法基于已知量MEMSIMU陀螺输出的设备系下的三维角速度信息
(1)为减小陀螺输出数据时的不正常扰动,提高陀螺测量信息的鲁棒性,本发明设计一种采用滑动窗3阶拉盖尔多项式抗差拟合处理方法对陀螺输出信息进行抗差处理;
设置滑动窗口长度为N=10,当陀螺采样个数,即N<10时不做处理,当N≥10时分别对陀螺的测量信息处理如下:
其中,
经过该抗差处理后可得到一系列序列号为
其中,
(2)针对水下航行器运动过程中出现剧烈晃动而导致传统AR模型对误差无法精准建模的问题,使用步骤(1)得到的陀螺角速度信息建立改进的实时AR模型;
设置窗口长度N=20的滑动窗,首先对每一个滑动窗取均值为:
其中
随后建立改进的AR模型如下:
其中
其中
(3)使用以IGGIII法为权函数的抗差最小二乘估计参数;
使用以IGGIII法为权函数的抗差最小二乘估计,IGGIII法的权因子为:
其中
。
(4)后向平滑卡尔曼滤波补偿。
卡尔曼滤波过程如下:
系统的状态方程为:
其中
其中
其中
下面进入后向平滑过程更新
其中
将所得
为了验证本发明方法的有效性,开展车载惯性导航实验。使用光纤陀螺惯性测量单元设备。其中图2给出了实验过程中车辆的运动轨迹路线。图3是对应的位置误差曲线,其中,纯惯性方法误差最大;本发明方法的定位误差小于传统AR模型方法。
需要说明的是,以上内容仅仅说明了本发明的技术思想,不能以此限定本发明的保护范围,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰均落入本发明权利要求书的保护范围之内。
- 基于改进EMD的MEMS陀螺随机误差建模滤波方法
- 基于改进粒子滤波的MEMS陀螺随机误差补偿方法