CN111189447A - Low-pass filtering method of position measurement inertial navigation system - Google Patents
Low-pass filtering method of position measurement inertial navigation system Download PDFInfo
- Publication number
- CN111189447A CN111189447A CN201811363081.6A CN201811363081A CN111189447A CN 111189447 A CN111189447 A CN 111189447A CN 201811363081 A CN201811363081 A CN 201811363081A CN 111189447 A CN111189447 A CN 111189447A
- Authority
- CN
- China
- Prior art keywords
- pass filtering
- low
- navigation system
- inertial navigation
- position measurement
- 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.)
- Pending
Links
- 238000001914 filtration Methods 0.000 title claims abstract description 73
- 238000000034 method Methods 0.000 title claims abstract description 34
- 238000005259 measurement Methods 0.000 title claims abstract description 24
- 238000001514 detection method Methods 0.000 claims abstract description 9
- 238000004364 calculation method Methods 0.000 claims abstract description 6
- 238000003672 processing method Methods 0.000 claims description 10
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000013307 optical fiber Substances 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
Abstract
The invention belongs to the technical field of inertial navigation, and particularly relates to a low-pass filtering method of a position measurement inertial navigation system. According to the method, an ultra-low frequency filtering algorithm is added after the output data of the inertial device is compensated and before navigation calculation, so that the influence of high-frequency noise such as random error of the inertial device on the position measurement precision is eliminated. The method comprises the three steps of selecting a second-order low-pass filtering method, determining a gyroscope and an accelerometer, and obtaining a low-pass filtering processing formula. According to the method, Chebyshev low-pass filtering is added into error compensation of the inertial navigation system for the first time, and the ultralow-pass filtering parameters are designed according to the application characteristics of the track detection device.
Description
Technical Field
The invention belongs to the technical field of inertial navigation, and particularly relates to a low-pass filtering method of a position measurement inertial navigation system.
Background
An inertial navigation system applied to a track detection position measuring device needs to accurately measure position data of a track. The inertial navigation system mainly comprises an inertial information sensitive device optical fiber gyroscope and an accelerometer, position measurement data also brings certain noise due to the fact that the inertial device has high-frequency noise such as random constants, random slopes and the like, when the inertial navigation system is applied to a general inertial navigation system, the noise error of the inertial device can be ignored due to the fact that the navigation resolving process is equivalent to integral processing of the inertial device, but when the track detection device is applied, firstly, the requirement on position measurement accuracy is high, and secondly, a data calculation method is different from other inertial navigation systems, and therefore the error must be processed.
Disclosure of Invention
The invention provides a low-pass filtering processing method for an inertial navigation system for measuring a track detection position.
According to the method, an ultra-low frequency filtering algorithm is added after the output data of the inertial device is compensated and before navigation calculation, so that the influence of high-frequency noise such as random error of the inertial device on the position measurement precision is eliminated.
In order to realize the purpose, the invention adopts the technical scheme that:
a low-pass filtering method of a position measurement inertial navigation system comprises the following three steps of selecting a second-order low-pass filtering method, determining a gyroscope and an accelerometer, and obtaining a low-pass filtering processing formula.
A low-pass filtering method of a position measurement inertial navigation system comprises the following steps of firstly, selecting a second-order low-pass filtering method;
according to the characteristics of the output data of the inertial device, a second-order low-pass filtering method is selected, and the transfer function is as follows:
the implementation form of formula (1) is:
y(k)=a0x(k)+a1x(k-1)+a2x(k-2)-b1y(k-1)-b2y(k-2)……………(2)
(1) in formulae (2) and
a0、a1、a2、b1、b2is a filtering parameter;
y (k), y (k-1) and y (k-2) are respectively the filtering output results at the current moment (k moment), the k-1 moment and the k-2 moment;
x (k), x (k-1) and x (k-2) are filter input values at the current time (k time), k-1 time and k-2 time, respectively.
The second step is to determine a gyroscope and an accelerometer;
and determining that the gyroscope adopts 0.5Hz second-order low-pass filtering and the accelerometer adopts 1Hz second-order low-pass filtering according to the requirement characteristic of the track detection device on the position measurement data.
A low-pass filtering method of a position measurement inertial navigation system, the third step is to obtain a low-pass filtering processing formula;
respectively substituting the filtering parameters of the gyroscope and the accelerometer into the formula (2) to obtain a low-pass filtering processing formula, wherein the gyroscope filtering processing method is as the formula (3),
the filtering processing method of the accelerometer is as the formula (4).
The calculation in the formula (3) and the formula (4) is added in the inertial navigation system software, so that the low-pass filtering processing method is realized.
A low-pass filtering method for a position measurement inertial navigation system, byCalculating to obtain a filtering parameter of the gyroscope as a0=0.0000098259,a1=0.0000196518,a2=0.0000098259, b1=-1.99111429,b2=0.9911535958。
A low-pass filtering method for position measurement inertial navigation system features that the accelerometer has the filtering parameter b0=0.0000391302,b1=0.0000782604,b2=0.0000391302,a1=1.9822289298, a2=-0.9823854506。
The invention has the beneficial effects that:
according to the method, Chebyshev low-pass filtering is added into error compensation of the inertial navigation system for the first time, and the ultralow-pass filtering parameters are designed according to the application characteristics of the track detection device.
Drawings
Is free of
Detailed Description
The present invention will be described in detail with reference to specific examples.
A low-pass filtering method of a position measurement inertial navigation system comprises the steps of selecting a second-order low-pass filtering method, determining a gyroscope and an accelerometer, and obtaining a low-pass filtering processing formula.
Step one, selecting a second-order low-pass filtering method
According to the characteristics of the output data of the inertial device, a second-order low-pass filtering method is selected, and the transfer function is as follows:
the implementation form of formula (1) is:
y(k)=a0x(k)+a1x(k-1)+a2x(k-2)-b1y(k-1)-b2y(k-2)……………(2)
(2) in formulae (2) and
a0、a1、a2、b1、b2is a filtering parameter;
y (k), y (k-1) and y (k-2) are respectively the filtering output results at the current moment (k moment), the k-1 moment and the k-2 moment;
x (k), x (k-1) and x (k-2) are respectively filtering input values at the current moment (k moment), the k-1 moment and the k-2 moment;
step two, determining a gyroscope and an accelerometer
And determining that the gyroscope adopts 0.5Hz second-order low-pass filtering and the accelerometer adopts 1Hz second-order low-pass filtering according to the requirement characteristic of the track detection device on the position measurement data.
The filtering parameter of the gyroscope is calculated to be a0=0.0000098259 a1=0.0000196518 a2=0.0000098259 b1=-1.99111429 b2=0.9911535958
The filter parameter of the accelerometer is b0=0.0000391302 b1=0.0000782604 b2=0.0000391302a1=1.9822289298 a2=-0.9823854506
Step three, acquiring a low-pass filtering processing formula
And (3) respectively substituting the filtering parameters of the gyroscope and the accelerometer into the formula (2) to obtain a low-pass filtering processing formula. The gyro filtering processing method is as formula (3).
The filtering processing method of the accelerometer is as the formula (4).
The calculation in the formula (3) and the formula (4) is added in the inertial navigation system software, so that the low-pass filtering processing method is realized.
Claims (7)
1. A low-pass filtering method of a position measurement inertial navigation system comprises three steps, and is characterized in that: selecting a second-order low-pass filtering method, determining a gyroscope and an accelerometer, and acquiring a low-pass filtering processing formula.
2. A method of low-pass filtering of a position measurement inertial navigation system, as claimed in claim 1, wherein: the first step is to select a second-order low-pass filtering method;
according to the characteristics of the output data of the inertial device, a second-order low-pass filtering method is selected, and the transfer function is as follows:
the implementation form of formula (1) is:
y(k)=a0x(k)+a1x(k-1)+a2x(k-2)-b1y(k-1)-b2y(k-2)……………(2)
(1) in formulae (2) and
a0、a1、a2、b1、b2is a filtering parameter;
y (k), y (k-1) and y (k-2) are respectively the filtering output results at the current moment (k moment), the k-1 moment and the k-2 moment;
x (k), x (k-1) and x (k-2) are filter input values at the current time (k time), k-1 time and k-2 time, respectively.
3. A method of low-pass filtering of a position measurement inertial navigation system, as claimed in claim 1, wherein: secondly, determining a gyroscope and an accelerometer;
and determining that the gyroscope adopts 0.5Hz second-order low-pass filtering and the accelerometer adopts 1Hz second-order low-pass filtering according to the requirement characteristic of the track detection device on the position measurement data.
4. A method of low-pass filtering of a position measurement inertial navigation system, as claimed in claim 1, wherein: thirdly, acquiring a low-pass filtering processing formula;
respectively substituting the filtering parameters of the gyroscope and the accelerometer into the formula (2) to obtain a low-pass filtering processing formula, wherein the gyroscope filtering processing method is as the formula (3),
the filtering processing method of the accelerometer is as the formula (4).
The calculation in the formula (3) and the formula (4) is added in the inertial navigation system software, so that the low-pass filtering processing method is realized.
5. A method of low-pass filtering of a position measurement inertial navigation system according to claim 3, characterized in that: the filtering parameter of the gyroscope is calculated to be a0=0.0000098259,a1=0.0000196518,a2=0.0000098259,b1=-1.99111429,b2=0.9911535958。
6. A method of low-pass filtering of a position measurement inertial navigation system according to claim 3, characterized in that: the filter parameter of the accelerometer is b0=0.0000391302,b1=0.0000782604,b2=0.0000391302,a1=1.9822289298,a2=-0.9823854506。
7. A method of low-pass filtering of a position measurement inertial navigation system, as claimed in claim 1, wherein: the method is applied to an inertial navigation system for measuring the track detection position.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811363081.6A CN111189447A (en) | 2018-11-15 | 2018-11-15 | Low-pass filtering method of position measurement inertial navigation system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811363081.6A CN111189447A (en) | 2018-11-15 | 2018-11-15 | Low-pass filtering method of position measurement inertial navigation system |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111189447A true CN111189447A (en) | 2020-05-22 |
Family
ID=70707082
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811363081.6A Pending CN111189447A (en) | 2018-11-15 | 2018-11-15 | Low-pass filtering method of position measurement inertial navigation system |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111189447A (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112378418A (en) * | 2020-10-30 | 2021-02-19 | 哈尔滨理工大学 | Gyro signal high-order low-pass filtering and hysteresis compensation method |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101430617A (en) * | 2007-10-30 | 2009-05-13 | 晶翔微***股份有限公司 | Accelerometer data processing method for controlling cursor movement and cursor control device |
CN103345149A (en) * | 2013-06-24 | 2013-10-09 | 北京航天控制仪器研究所 | Dynamically tuned gyroscope servo control loop |
CN104280047A (en) * | 2014-09-10 | 2015-01-14 | 天津航天中为数据***科技有限公司 | Gyroscope shift filtering system and method integrating multiple sensors |
CN204788410U (en) * | 2015-05-20 | 2015-11-18 | 重庆华渝电气集团有限公司 | Novel top combination |
CN105739510A (en) * | 2016-01-13 | 2016-07-06 | 天津中科智能识别产业技术研究院有限公司 | Complementary filtering method for disaster relief unmanned aerial vehicle attitude control |
-
2018
- 2018-11-15 CN CN201811363081.6A patent/CN111189447A/en active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101430617A (en) * | 2007-10-30 | 2009-05-13 | 晶翔微***股份有限公司 | Accelerometer data processing method for controlling cursor movement and cursor control device |
CN103345149A (en) * | 2013-06-24 | 2013-10-09 | 北京航天控制仪器研究所 | Dynamically tuned gyroscope servo control loop |
CN104280047A (en) * | 2014-09-10 | 2015-01-14 | 天津航天中为数据***科技有限公司 | Gyroscope shift filtering system and method integrating multiple sensors |
CN204788410U (en) * | 2015-05-20 | 2015-11-18 | 重庆华渝电气集团有限公司 | Novel top combination |
CN105739510A (en) * | 2016-01-13 | 2016-07-06 | 天津中科智能识别产业技术研究院有限公司 | Complementary filtering method for disaster relief unmanned aerial vehicle attitude control |
Non-Patent Citations (1)
Title |
---|
杨娟等: "基于DSP 的MEMS 陀螺去噪算法研究", 《电子测量技术》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112378418A (en) * | 2020-10-30 | 2021-02-19 | 哈尔滨理工大学 | Gyro signal high-order low-pass filtering and hysteresis compensation method |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR101739390B1 (en) | Method for improving the accuracy of self-alignment about the inertial navigation system through gravitational error compensation | |
US10209078B2 (en) | Local perturbation rejection using time shifting | |
CN111121768A (en) | Robot pose estimation method and device, readable storage medium and robot | |
WO2018141198A1 (en) | Method and device for detecting flight altitude of unmanned aerial vehicle, and unmanned aerial vehicle | |
CN110879302B (en) | Temperature compensation method for quartz resonance differential accelerometer | |
CN103913171A (en) | Compensation measurement method for rotary speed and rotary angle of carrier based on accelerometer and gyroscope | |
CN112325903B (en) | Inertial acceleration filtering decoupling method based on pattern recognition | |
WO2022205623A1 (en) | Zero-bias compensation method for inertial measurement sensor | |
Jafari et al. | PEM stochastic modeling for MEMS inertial sensors in conventional and redundant IMUs | |
Narasimhappa et al. | An innovation based random weighting estimation mechanism for denoising fiber optic gyro drift signal | |
CN112304337A (en) | Motion angle estimation method and system based on gyroscope and accelerometer | |
CN111189447A (en) | Low-pass filtering method of position measurement inertial navigation system | |
JP2020098622A (en) | Method of measuring variance of measurement signal, data fusion method, computer program, machine-readable storage medium, and device | |
US10267649B2 (en) | Method and apparatus for calculating azimuth | |
CN112989625A (en) | Method for eliminating abnormal value of UWB sensor | |
CN110864684A (en) | User posture measuring and calculating method | |
US9267814B2 (en) | System and process for determining offsets of measuring instruments | |
CN115727871A (en) | Track quality detection method and device, electronic equipment and storage medium | |
EP3254063B1 (en) | A system for and a method of measuring a path length using a handheld electronic device | |
CN108716925A (en) | A kind of scaling method and device of nine axle sensors | |
CN113959464A (en) | Gyroscope-assisted accelerometer field calibration method and system | |
CN109033646B (en) | Method for calculating gravity tool face angle of inclinometer while drilling based on small-range MEMS acceleration sensor | |
Kundra et al. | Bias compensation of gyroscopes in mobiles with optical flow | |
Nazemipour et al. | MEMS gyroscope raw data noise reduction using fading memory filter | |
CN113076826B (en) | Filtering method and device of sensor |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20200522 |