CN103940447A - 一种基于自适应数字滤波器的系泊状态初始对准方法 - Google Patents
一种基于自适应数字滤波器的系泊状态初始对准方法 Download PDFInfo
- Publication number
- CN103940447A CN103940447A CN201410145821.4A CN201410145821A CN103940447A CN 103940447 A CN103940447 A CN 103940447A CN 201410145821 A CN201410145821 A CN 201410145821A CN 103940447 A CN103940447 A CN 103940447A
- Authority
- CN
- China
- Prior art keywords
- digital filter
- filter
- omega
- gyroscope
- accelerometer
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Abstract
本发明一种基于自适应数字滤波器的系泊状态初始对准方法:将捷联惯导系统安装在载体上;利用二阶隐马尔科夫卡尔曼滤波器对陀螺仪和加速度计的原始输出信号进行滤波,并通过滤波器的稳态参数测量自适应截止频率fc;获取低通巴特沃斯IIR数字滤波器的阶数N,并用此滤波器对陀螺仪和加速度计的原始输出信号进行滤波;利用低通巴特沃斯IIR数字滤波器输出的加速度计信息获取修正角速度利用低通巴特沃斯IIR数字滤波器输出的陀螺仪信息和修正角速度获得对准姿态矩阵,完成系统初始对准的任务。本发明可用于提高捷联惯性导航系统的对准精度。
Description
技术领域
本发明涉及一种基于自适应数字滤波器的系泊状态初始对准方法,可用于提高捷联惯性导航系统的对准精度,属于惯性导航技术领域。
背景技术
初始对准是捷联惯导系统导航工作的前提,初始对准的好坏直接影响系统的导航精度,所以在导航前得到精确的初始姿态矩阵尤为重要。系泊状态下,载体会受到各种频率段的噪声干扰。如果在整个对准过程中,陀螺和加速度计的输出信号不能得到有效处理,受惯性测量单元(Inertial Measurement Unit,IMU)高频噪声的影响,系统对准效果并不理想。数字滤波器能有效降低对准环境下的噪声水平,更为重要的是滤除了陀螺高频噪声,增强了系统抗干扰的能力。目前对器件中的高频随机噪声最常用的处理方法是采用低阶平滑滤波器进行消噪,从而获得更为准确的加速度和角加速度信息,此方法可以在一定程度上提高捷联惯导系统的精度。
发明内容
本发明的目的是提供具有高对准精度的一种基于自适应数字滤波器的系泊状态初始对准方法。
本发明是通过以下技术方案实现的:
一种基于自适应数字滤波器的系泊状态初始对准方法,包括以下几个步骤,
步骤一:将捷联惯导系统安装在载体上,并且使IMU坐标系的三根轴与载体系的三轴平行;
步骤二:自适应数字滤波器由二阶隐马尔科夫卡尔曼滤波器和低通巴特沃斯IIR数字滤波器组成,利用二阶隐马尔科夫卡尔曼滤波器对陀螺仪和加速度计的原始输出信号进行滤波,并通过滤波器的稳态参数测量自适应截止频率fc:
式中,k11是二阶隐马尔科夫卡尔曼滤波器稳态滤波增益矩阵中的第一个元素值;
步骤三:利用自适应截止频率fc获取低通巴特沃斯IIR数字滤波器的阶数N,并用此滤波器对陀螺仪和加速度计的原始输出信号进行滤波;
四阶巴特沃斯IIR数字滤波器的幅度平方函数为:
ωc=2πfc自适应数字滤波器的截止角频率,滤波器的阶数N的测量公式为:
式中,ωst=2ωc是阻带下限截止频率;δ1=3dB是通带最大衰减;δ2=20dB是阻带最小衰减,滤波器的阶数N取大于N′的最小整数;
步骤四:利用低通巴特沃斯IIR数字滤波器输出的加速度计信息获取修正角速度
步骤五:利用低通巴特沃斯IIR数字滤波器输出的陀螺仪信息和修正角速度获得对准姿态矩阵,完成系统初始对准的任务。
本发明的有益效果:
本发明涉及的基于自适应数字滤波器的系泊状态初始对准方法可以根据系统噪声获取数字滤波器的自适应截止频率,有效消除惯性器件中的高频随机噪声对系统对准结果的影响,使系统对准后的捷联姿态矩阵更接近与真实值,提高系统导航精度。
附图说明
图1是本发明方案实施流程图。
具体实施方式
下面将结合附图对本发明进行详细说明:
本发明的原理是:针对陀螺仪和加速度计的输出信号和真实信号建立的二阶隐马尔科夫卡尔曼滤波器在滤波达到稳态时,其滤波模型可以转换为常规的数字滤波器模型,而其稳态滤波增益参数则可用于获取数字滤波器的自适应截止频率,用该频率设计出低通巴特沃斯IIR滤波器处理捷联惯导系统初始对准输出的陀螺仪和加速度计信息,消除惯性器件中的高频随机噪声,从而获得更加准确的初始对准姿态矩阵,提高系统后续导航精度,如图1所示。
(1)将捷联惯导系统安装在载体上,并且使IMU坐标系的三根轴与载体坐标系(b系)的三轴平行,系统开机后预热1小时。
(2)利用二阶隐马尔科夫卡尔曼滤波器对陀螺仪和加速度计的原始输出信号进行滤波,并通过滤波器的稳态参数测量自适应截止频率。自适应截止频率的测量公式为:
式中,k11是二阶隐马尔科夫卡尔曼滤波器稳态滤波增益矩阵中的第一个元素值。
(3)利用自适应截止频率fc获取巴特沃斯IIR数字低通滤波器的阶数N,并用此滤波器对陀螺仪和加速度计的原始输出信号进行滤波。
四阶巴特沃斯IIR数字滤波器的幅度平方函数为:
ωc=2πfc自适应数字滤波器的截止角频率,滤波器的阶数N的测量公式为:
式中,ωst=2ωc是阻带下限截止频率;δ1=3dB是通带最大衰减;δ2=20dB是阻带最小衰减。滤波器的阶数N取大于N′的最小整数。
将陀螺仪和加速度计的原始输出信号和输入到巴特沃斯IIR数字低通滤波器中,消除信号中的高频随机噪声,滤波后的加速度与角加速度信号分别为和
(4)利用自适应数字滤波器输出的加速度计信息获取修正角速度其中上角标t表示地理坐标系,在捷联惯导系统中,导航坐标系(n系)与地理坐标系(t系)重合。
(5)利用自适应数字滤波器输出的陀螺仪信息和修正角速度获得对准姿态矩阵,完成系统初始对准的任务。
陀螺仪滤波后的输出信号为修正后的由下式获得:
是导航坐标系相对惯性空间的角速度在载体系的投影,由通过捷联姿态矩阵坐标变换获得,由地球自转角速度和载体运动引起的角速度在导航坐标系投影得。
用四元数法和修正后的逐步迭代计算系统的捷联姿态矩阵完成系统初始对准过程。
Claims (1)
1.一种基于自适应数字滤波器的系泊状态初始对准方法,其特征在于:包括以下几个步骤,
步骤一:将捷联惯导系统安装在载体上,并且使IMU坐标系的三根轴与载体系的三轴平行;
步骤二:自适应数字滤波器由二阶隐马尔科夫卡尔曼滤波器和低通巴特沃斯IIR数字滤波器组成,利用二阶隐马尔科夫卡尔曼滤波器对陀螺仪和加速度计的原始输出信号进行滤波,并通过滤波器的稳态参数测量自适应截止频率fc:
式中,k11是二阶隐马尔科夫卡尔曼滤波器稳态滤波增益矩阵中的第一个元素值;
步骤三:利用自适应截止频率fc获取低通巴特沃斯IIR数字滤波器的阶数N,并用此滤波器对陀螺仪和加速度计的原始输出信号进行滤波;
四阶巴特沃斯IIR数字滤波器的幅度平方函数为:
ωc=2πfc自适应数字滤波器的截止角频率,滤波器的阶数N的测量公式为:
式中,ωst=2ωc是阻带下限截止频率;δ1=3dB是通带最大衰减;δ2=20dB是阻带最小衰减,滤波器的阶数N取大于N′的最小整数;
步骤四:利用低通巴特沃斯IIR数字滤波器输出的加速度计信息获取修正角速度
步骤五:利用低通巴特沃斯IIR数字滤波器输出的陀螺仪信息和修正角速度获得对准姿态矩阵,完成系统初始对准的任务。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410145821.4A CN103940447B (zh) | 2014-04-11 | 2014-04-11 | 一种基于自适应数字滤波器的系泊状态初始对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410145821.4A CN103940447B (zh) | 2014-04-11 | 2014-04-11 | 一种基于自适应数字滤波器的系泊状态初始对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103940447A true CN103940447A (zh) | 2014-07-23 |
CN103940447B CN103940447B (zh) | 2017-02-01 |
Family
ID=51188215
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410145821.4A Expired - Fee Related CN103940447B (zh) | 2014-04-11 | 2014-04-11 | 一种基于自适应数字滤波器的系泊状态初始对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103940447B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107589441A (zh) * | 2017-09-07 | 2018-01-16 | 成都理工大学 | 基于卡尔曼滤波器通道的脉冲堆积修正方法 |
CN108459504A (zh) * | 2018-03-08 | 2018-08-28 | 上海阜有海洋科技有限公司 | 多点系泊协同自适应迭代学习控制方法 |
CN111669149A (zh) * | 2020-06-21 | 2020-09-15 | 陕西航空电气有限责任公司 | 一种自适应巴特沃斯低通数字滤波器设计方法 |
CN114763994A (zh) * | 2021-05-06 | 2022-07-19 | 苏州精源创智能科技有限公司 | 一种应用于扫地机器人的惯性姿态导航系统 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101672649A (zh) * | 2009-10-20 | 2010-03-17 | 哈尔滨工程大学 | 一种基于数字低通滤波的船用光纤捷联系统系泊对准方法 |
CN103245360A (zh) * | 2013-04-24 | 2013-08-14 | 北京工业大学 | 晃动基座下的舰载机旋转式捷联惯导系统自对准方法 |
-
2014
- 2014-04-11 CN CN201410145821.4A patent/CN103940447B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101672649A (zh) * | 2009-10-20 | 2010-03-17 | 哈尔滨工程大学 | 一种基于数字低通滤波的船用光纤捷联系统系泊对准方法 |
CN103245360A (zh) * | 2013-04-24 | 2013-08-14 | 北京工业大学 | 晃动基座下的舰载机旋转式捷联惯导系统自对准方法 |
Non-Patent Citations (2)
Title |
---|
王立冬等: "《摇摆状态下车载捷联惯导系统初始对准方法研究》", 《电光与控制》 * |
王艳东等: "《系泊状态舰载捷联惯导初始对准算法设计》", 《中国惯性技术学报》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107589441A (zh) * | 2017-09-07 | 2018-01-16 | 成都理工大学 | 基于卡尔曼滤波器通道的脉冲堆积修正方法 |
CN107589441B (zh) * | 2017-09-07 | 2019-08-02 | 成都理工大学 | 基于卡尔曼滤波器通道的脉冲堆积修正方法 |
CN108459504A (zh) * | 2018-03-08 | 2018-08-28 | 上海阜有海洋科技有限公司 | 多点系泊协同自适应迭代学习控制方法 |
CN111669149A (zh) * | 2020-06-21 | 2020-09-15 | 陕西航空电气有限责任公司 | 一种自适应巴特沃斯低通数字滤波器设计方法 |
CN111669149B (zh) * | 2020-06-21 | 2022-11-22 | 陕西航空电气有限责任公司 | 一种自适应巴特沃斯低通数字滤波器设计方法 |
CN114763994A (zh) * | 2021-05-06 | 2022-07-19 | 苏州精源创智能科技有限公司 | 一种应用于扫地机器人的惯性姿态导航系统 |
CN114763994B (zh) * | 2021-05-06 | 2024-01-30 | 苏州精源创智能科技有限公司 | 一种应用于扫地机器人的惯性姿态导航系统 |
Also Published As
Publication number | Publication date |
---|---|
CN103940447B (zh) | 2017-02-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR101988786B1 (ko) | 관성 항법 장치의 초기 정렬 방법 | |
EP2472225B1 (en) | Method and system for initial quaternion and attitude estimation | |
CN105300381A (zh) | 一种基于改进互补滤波的自平衡移动机器人姿态快速收敛方法 | |
CN106482734A (zh) | 一种用于imu多传感器数据融合的滤波方法 | |
CN103940447A (zh) | 一种基于自适应数字滤波器的系泊状态初始对准方法 | |
Sun et al. | Mooring alignment for marine SINS using the digital filter | |
CN109883392B (zh) | 一种基于相位补偿的捷联惯导升沉测量方法 | |
CN103217699B (zh) | 一种基于偏振信息的组合导航系统递推优化初始对准方法 | |
CN101929862A (zh) | 基于卡尔曼滤波的惯性导航系统初始姿态确定方法 | |
CN104280047A (zh) | 一种多传感器融合的陀螺漂移滤波系统及方法 | |
CN110207698B (zh) | 一种极区格网惯导/超短基线紧组合导航方法 | |
CN105698789A (zh) | 舰船升沉测量方法及其测量系统 | |
CN109471192B (zh) | 一种全自动重力测试仪高精度动态数据处理方法 | |
CN112985384A (zh) | 一种抗干扰磁航向角优化系统 | |
CN107024226B (zh) | 一种基于惯导/dvl/usbl组合的惯导误差估计方法 | |
CN105698799B (zh) | 一种提高捷联惯导系统姿态精度的预处理最优fir滤波器 | |
CN108120452A (zh) | Mems陀螺仪动态数据的滤波方法 | |
KR101858976B1 (ko) | 자세 및 방위각 측정장치의 가속도센서 신호처리 방법 | |
CN112629540B (zh) | 一种基于载体姿态信息的升沉测量方法 | |
EP3410074B1 (en) | Method and device for improving performance of relative-position sensor, and computer storage medium | |
CN103630134A (zh) | 一种基于2d-hmm/kf预滤波器的系泊对准方法 | |
CN106871891B (zh) | 一种基于累加累减混合微分器的信号去噪方法 | |
CN110209049B (zh) | 一种基于惯性回路的窄带大幅值扰动抑制方法 | |
CN110596425B (zh) | 一种无人机mems加速度传感器噪声消除方法 | |
CN107664499B (zh) | 一种船用捷联惯导系统的加速度计在线降噪方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170201 |