CN110793517B - Broadband micro angular velocity measurement method based on multi-rate fusion technology - Google Patents

Broadband micro angular velocity measurement method based on multi-rate fusion technology Download PDF

Info

Publication number
CN110793517B
CN110793517B CN201911013824.1A CN201911013824A CN110793517B CN 110793517 B CN110793517 B CN 110793517B CN 201911013824 A CN201911013824 A CN 201911013824A CN 110793517 B CN110793517 B CN 110793517B
Authority
CN
China
Prior art keywords
sensors
matrix
micro
fusion
noise
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.)
Active
Application number
CN201911013824.1A
Other languages
Chinese (zh)
Other versions
CN110793517A (en
Inventor
李醒飞
闫俊全
刘帆
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Tianjin University
Original Assignee
Tianjin University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Tianjin University filed Critical Tianjin University
Priority to CN201911013824.1A priority Critical patent/CN110793517B/en
Publication of CN110793517A publication Critical patent/CN110793517A/en
Application granted granted Critical
Publication of CN110793517B publication Critical patent/CN110793517B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; 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/16Navigation; 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
    • G01C21/165Navigation; 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 combined with non-inertial navigation instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; 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/16Navigation; 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
    • G01C21/18Stabilised platforms, e.g. by gyroscope

Abstract

The invention discloses a broadband micro angular velocity measurement method based on a multi-rate fusion technology, which comprises the following steps: (1) Fixing two sensors on a rotary table, enabling sensitive axes of the two sensors to be collinear with a rotary shaft of the rotary table, connecting a signal wire to a collection card, and starting collection after power is turned on; (2) Synchronizing sampling rates of output signals of the two sensors; (3) And constructing a state equation and an observation equation, and carrying out Kalman filtering fusion on the synchronized signals. The two sensors are an MHD micro-angle vibration sensor and a high-precision gyroscope respectively, and in the step (2), the high-precision gyroscope is up-sampled or the MHD micro-angle vibration sensor is down-sampled, so that the sampling rates of the two sensors are uniform.

Description

Broadband micro angular velocity measurement method based on multi-rate fusion technology
Technical Field
The invention belongs to the technical field of test and measurement, and particularly relates to a broadband micro angular velocity measurement method based on a multi-rate fusion technology.
Background
High-precision spacecrafts represented by high-resolution remote sensing satellites play an important role in the fields of earth observation, deep space exploration, laser communication and the like. However, due to the existence of various micro-vibration disturbance sources such as a momentum wheel high-speed rotating component, a solar cell array driving stepping component, space debris collision impact and the like, a spacecraft and a payload thereof can be disturbed by micro-vibration with small amplitude in an in-orbit running process. The frequency spectrum contains high-frequency angular micro-vibration of thousands of hertz, and the imaging quality of high-resolution earth observation of a spacecraft is seriously affected, so that a vibration reduction system must be designed for loads such as a high-resolution camera and the like, and the active inhibition capability of a load platform on the micro-angular vibration is improved.
In order to detect the micro-angle vibration signal of the load platform and feed back the micro-angle vibration signal to the active vibration damping system in real time, the micro-angle vibration sensor needs to have the characteristics of wide frequency band, high precision, small volume, shock resistance, long service life and the like. The micro-angle vibration sensor based on the principle of Magnetohydrodynamics (MHD) can meet the requirements, is particularly suitable for high-frequency micro-angle vibration measurement, and is a relatively mature satellite platform micro-angle vibration sensor at present.
However, due to principle limitations, the MHD micro-angle vibration sensor does not respond well to low frequency angle vibration signals below 1Hz, which is embodied as low frequency amplitude attenuation and phase error increase, and cannot respond to direct current signals, so that low frequency motion information of a spacecraft payload cannot be effectively measured, and therefore, the low frequency error of the MHD micro-angle vibration sensor must be effectively compensated.
Chinese patent CN106840155a proposes a scheme for fusion measurement of MHD micro-angle vibration sensor and MEMS gyroscope, but the scheme is only suitable for fusion of sensors with the same rate, and has no requirement of taking the noise characteristics of the sensors as fusion basis and evaluation index of fusion effect, and has great limitation.
Disclosure of Invention
The invention aims to overcome the defects in the prior art and provides a broadband micro angular velocity measurement method based on a multi-rate fusion technology. The method aims to effectively compensate amplitude attenuation and phase errors of the MHD micro-angle vibration sensor under the low-frequency condition by utilizing the characteristic that the high-precision gyroscope performs well under the low-frequency (< 10 Hz) vibration condition, and meanwhile, the original ideal high-frequency characteristic of the MHD micro-angle vibration sensor is ensured, and the fluctuation of the output amplitude along with the frequency is controlled in a smaller range, so that full-band measurement is realized.
The invention aims at realizing the following technical scheme:
a wideband micro angular velocity measurement method based on a multi-rate fusion technology comprises the following steps:
(1) Fixing two sensors on a rotary table, enabling sensitive axes of the two sensors to be collinear with a rotary shaft of the rotary table, connecting a signal wire to a collection card, and starting collection after power is turned on;
(2) Synchronizing sampling rates of output signals of the two sensors;
(3) And constructing a state equation and an observation equation, and carrying out Kalman filtering fusion on the synchronized signals.
Further, the two sensors are an MHD micro-angle vibration sensor and a high-precision gyroscope respectively, and in the step (2), the high-precision gyroscope is up-sampled or the MHD micro-angle vibration sensor is down-sampled, so that the sampling rates of the two sensors are uniform;
the CIC filter, namely a cascade integral comb filter, is used for eliminating image frequency components introduced by up-sampling or aliasing components caused by down-sampling; then applying Noble equivalence transformation, equivalent exchange filter and decimator or interpolator positions.
Further, the step (3) includes the steps of:
(301) Modeling the motion of an object to be observed, determining a state transition matrix and process noise, and listing a state transition differential equation of the object;
(302) Modeling the two sensors, determining an observation matrix and observation noise, and listing the observation equation of the sensor group;
(303) Performing Kalman recursion estimation, and dividing the Kalman recursion estimation into two parts: predicting and updating; wherein predicting comprises performing a priori estimates of state values, a priori estimates of noise covariance; updating the posterior estimation including calculating the Kalman gain and the state value and the noise covariance;
(304) And obtaining a state value through the observed values of the two sensors, and finishing the fusion of the two sensors.
Compared with the prior art, the technical scheme of the invention has the following beneficial effects:
1. the invention creatively uses the scheme of synchronous Kalman fusion, breaks through the limitation that the signal transmission rates of two sensors in the scheme of the reference patent are necessarily the same, can perform analog-digital sensor multi-rate fusion, double analog sensor multi-rate fusion and double digital sensor multi-rate fusion, expands the application range of the fusion scheme and improves the flexibility of the MHD micro-angle vibration sensor combination measurement scheme.
2. And in the second step, a CIC filter is selected as an anti-aliasing filter before extraction or a smoothing filter after interpolation, and the filter has a simple structure, is provided with an integrator and an adder, has no multiplier, has high calculation efficiency, and is very suitable for a system with high requirements on real-time performance, such as angular vibration measurement. On the basis, the novel equivalent transformation is applied to the extraction structure formed by the CIC filter and the extractor, so that a part of unnecessary filtering operation is reduced, and the time delay of the system is reduced to the greatest extent.
3. Different from the reference patent, the Kalman filtering fusion is selected, the state at the current moment is estimated only by the state at the previous moment, and the possibility is provided for the multi-sensor online fusion.
Drawings
FIG. 1 is a flow chart of the steps of the present invention.
Fig. 2 is a block diagram of decimated filtering to which Noble equivalence is applied.
Fig. 3 is a block diagram of CIC filter decimation to which Noble equivalence is applied.
Detailed Description
The invention is described in further detail below with reference to the drawings and the specific examples. It should be understood that the specific embodiments described herein are for purposes of illustration only and are not intended to limit the scope of the invention.
The invention provides a wideband micro angular velocity measurement method based on a multi-rate fusion technology, which is used for obtaining an optimized angular velocity value output by carrying out multi-rate fusion on an MHD micro angular vibration sensor and a high-precision gyroscope, thereby realizing full-band measurement. For better illustration, the MEMS gyroscope is selected as the high-precision gyroscope in this embodiment.
As shown in fig. 1, the method mainly comprises the following steps:
step one: acquisition of
The two sensors are fixed on the rotary table, so that the sensitive axes of the two sensors are collinear with the rotary shaft of the rotary table, then the signal wire is connected to the acquisition card, and the acquisition program is operated to start acquisition after the power is turned on.
Step two: fusion of
1. The sampling rate is synchronized.
Downsampling of the MHD micro-angle vibration sensor or upsampling of the MEMS gyroscope is described herein as an example of downsampling of the MHD.
The sampling frequency of the MEMS gyroscope is 2KHz, the sampling frequency of the MHD micro-angle vibration sensor is 10KHz, and 5 times of downsampling is required for reducing the MHD sampling rate to be consistent with the MEMS.
The locations of the filter and the decimator are exchanged by applying the Noble identity, so as to improve the response speed of the system, as shown in fig. 2.
The CIC filter is selected as a low-pass filter of the extraction structure, and the system function is as follows:
wherein M is the order of the CIC filter,is an integrator, H 2 (z)=1-Z -M Is a comb filter.
Applying the Noble equivalent to the CIC filter and decimator is to swap the positions of the downsampler and comb filter, the structure is shown in fig. 3.
2. Kalman filter fusion
And establishing a state equation and a measurement equation, and carrying out Kalman recursion estimation.
Wherein, establish the state equation:
x k =x k-1 +w k
x k =x k-1 +0.01
here, x k Is the angular velocity of an object, and has the unit of deg/s, w k Is process noise, which is regarded as a random process, w, because the motion condition of a target object cannot be known in advance k Take 0.01 according to the experience value.
Establishing an observation equation:
z k =H k X k +V k
wherein H is 1 For a sensor observation matrix, the dimension is 2x1, two components s 1 、s 2 The scale factors of the two sensors, respectively. H 1 The noise matrix is measured for the sensor and is a 2x1 dimensional matrix, and two components r 1 、r 2 The noise variance, z, of the two sensors, respectively 1 、z 2 The unit of the voltage output value of the two collected sensors at the kth moment is V.
After the state equation and the observation equation are established, four parameters required by Kalman iterative fusion are determined so far, and the four parameters are respectively a state transition matrix F:1, observation matrix H:process noise Q: w (w) k Measuring noise R: />
The following is a Kalman iterative fusion process:
prediction part:
1) Estimation using k-1 time instantCalculating a priori estimates of the current k moment +.>
2) Using the estimate P of time k-1 k-1|k-1 Calculating the current k momentPrior estimation covariance matrix P k|k-1
P k|k-1 =P k-1|k-1 +w k
Wherein P is k Is a 1x1 matrix because in this example only one state value, the angular velocity, is the initial value of 1.
An updating section:
3) Calculating Kalman gain for measuring accuracy degree:
4) Using Kalman gain K k Correcting the prior estimate based on the measured value:
wherein, kalman gain K k Is a 1x2 vector because one state value corresponds to two sensor measurements.
5) Updating the posterior estimation covariance matrix:
wherein I is an identity matrix.
And finally, transmitting the acquired sensor voltage output sequence into a fusion program, and carrying out iterative updating on the sequence to obtain a fused angular velocity estimation sequence.
So far, the more accurate estimated value of the angular velocity is obtained by multi-rate fusion of the two sensors, and the wide-band angular velocity measurement is completed.
The invention is not limited to the embodiments described above. The above description of specific embodiments is intended to describe and illustrate the technical aspects of the present invention, and is intended to be illustrative only and not limiting. Numerous specific modifications can be made by those skilled in the art without departing from the spirit of the invention and scope of the claims, which are within the scope of the invention.

Claims (1)

1. The wideband micro angular velocity measurement method based on the multi-rate fusion technology is characterized by comprising the following steps:
(1) Fixing two sensors on a rotary table, enabling sensitive axes of the two sensors to be collinear with a rotary shaft of the rotary table, connecting a signal wire to a collection card, and starting collection after power is turned on; the two sensors are an MHD micro-angle vibration sensor and a high-precision gyroscope respectively;
(2) Synchronizing sampling rates of output signals of the two sensors; up-sampling the high-precision gyroscope or down-sampling the MHD micro-angle vibration sensor to unify the sampling rates of the high-precision gyroscope and the MHD micro-angle vibration sensor; the CIC filter, namely a cascade integral comb filter, is used for eliminating image frequency components introduced by up-sampling or aliasing components caused by down-sampling; then applying Noble equivalent transformation, and equivalently exchanging the positions of the filter and the decimator or the interpolator;
(3) Constructing a state equation and an observation equation, and carrying out Kalman filtering fusion on the synchronized signals; the method comprises the following steps:
(301) Modeling the motion of an object to be observed, determining a state transition matrix and process noise, and listing a state transition differential equation of the object; wherein, establish the state equation:
x k =x k-1 +w k
x k =x k-1 +0.01
here, x k Is the angular velocity of an object, and has the unit of deg/s, w k Is process noise, which is regarded as a random process, w, because the motion condition of a target object cannot be known in advance k Taking 0.01 according to an empirical value;
(302) Modeling the two sensors, determining an observation matrix and observation noise, and listing the observation equation of the sensor group;
z k =H k X k +V k
wherein H is k For a sensor observation matrix, the dimension is 2x1, two components s 1 、s 2 The scale factors of the two sensors respectively; v (V) k The noise matrix is measured for the sensor and is a 2x1 dimensional matrix, and two components r 1 、r 2 The noise variance, z, of the two sensors, respectively 1 、z 2 The unit of the voltage output value of the two collected sensors is V;
(303) Performing Kalman recursion estimation, and dividing the Kalman recursion estimation into two parts: predicting and updating; wherein predicting comprises performing a priori estimates of state values, a priori estimates of noise covariance; updating the posterior estimation including calculating the Kalman gain and the state value and the noise covariance; four parameters required for performing the kalman iterative fusion are determined, and the four parameters are respectively a state transition matrix F:1, observation matrix H:process noise Q: w (w) k Measuring noise R: />
(304) Obtaining a state value through the observed values of the two sensors, and finishing fusion of the two sensors; the kalman iterative fusion process is as follows:
prediction part:
1) Estimation using k-1 time instantCalculating a priori estimates of the current k moment +.>
2) Using the estimate P of time k-1 k-1|k-1 Calculating prior estimation covariance matrix P of current k moment k|k-1
P k|k-1 =P k-1|k-1 +w k
Wherein P is k Is a 1x1 matrix, the state value is only angular velocity, and the initial value is 1;
an updating section:
3) Calculating Kalman gain for measuring accuracy degree:
4) Using Kalman gain K k Correcting the prior estimate based on the measured value:
wherein, kalman gain K k Is a 1x2 vector because one state value corresponds to two sensor measurements; z 1k 、z 2k The voltage output value of the two collected sensors at the kth moment is obtained;
5) Updating the posterior estimation covariance matrix:
wherein I is an identity matrix;
and finally, transmitting the acquired sensor voltage output sequence into a fusion program, and carrying out iterative updating on the sequence to obtain a fused angular velocity estimation sequence.
CN201911013824.1A 2019-10-23 2019-10-23 Broadband micro angular velocity measurement method based on multi-rate fusion technology Active CN110793517B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911013824.1A CN110793517B (en) 2019-10-23 2019-10-23 Broadband micro angular velocity measurement method based on multi-rate fusion technology

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911013824.1A CN110793517B (en) 2019-10-23 2019-10-23 Broadband micro angular velocity measurement method based on multi-rate fusion technology

Publications (2)

Publication Number Publication Date
CN110793517A CN110793517A (en) 2020-02-14
CN110793517B true CN110793517B (en) 2024-04-02

Family

ID=69441028

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911013824.1A Active CN110793517B (en) 2019-10-23 2019-10-23 Broadband micro angular velocity measurement method based on multi-rate fusion technology

Country Status (1)

Country Link
CN (1) CN110793517B (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114370930A (en) * 2020-10-15 2022-04-19 天津大学 Method for measuring satellite structure micro-angle vibration by using MHD micro-angle vibration sensor

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CH503997A (en) * 1968-12-19 1971-02-28 Honeywell Inc Angular velocity measuring device
US6173611B1 (en) * 1999-04-30 2001-01-16 A-Tech Corporation MHD sensor for measuring microradian angular rates and displacements
CN106840155A (en) * 2017-03-23 2017-06-13 天津大学 MHD angular-rate sensors and high accuracy gyroscope instrument combination measurement method
CN106940388A (en) * 2017-04-28 2017-07-11 天津大学 A kind of MHD angular-rate sensors dynamic noise measurement apparatus and method
CN106950400A (en) * 2017-04-28 2017-07-14 天津大学 A kind of MHD angular-rate sensors static noise measurement apparatus and method
CN108469269A (en) * 2018-01-19 2018-08-31 天津大学 A kind of resonance point test system of wideband inertial reference stabilized platform
CN109030850A (en) * 2018-09-20 2018-12-18 天津大学 A kind of MHD angular-rate sensor stablizes the driving device in modulation magnetic field
CN109556606A (en) * 2018-11-28 2019-04-02 吉林大学 Optimization method is measured based on fuzzy compensation and the sensor angles of Kalman filtering

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CH503997A (en) * 1968-12-19 1971-02-28 Honeywell Inc Angular velocity measuring device
US6173611B1 (en) * 1999-04-30 2001-01-16 A-Tech Corporation MHD sensor for measuring microradian angular rates and displacements
CN106840155A (en) * 2017-03-23 2017-06-13 天津大学 MHD angular-rate sensors and high accuracy gyroscope instrument combination measurement method
CN106940388A (en) * 2017-04-28 2017-07-11 天津大学 A kind of MHD angular-rate sensors dynamic noise measurement apparatus and method
CN106950400A (en) * 2017-04-28 2017-07-14 天津大学 A kind of MHD angular-rate sensors static noise measurement apparatus and method
CN108469269A (en) * 2018-01-19 2018-08-31 天津大学 A kind of resonance point test system of wideband inertial reference stabilized platform
CN109030850A (en) * 2018-09-20 2018-12-18 天津大学 A kind of MHD angular-rate sensor stablizes the driving device in modulation magnetic field
CN109556606A (en) * 2018-11-28 2019-04-02 吉林大学 Optimization method is measured based on fuzzy compensation and the sensor angles of Kalman filtering

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
李醒飞 等.一种MHD 角速度传感器与MEMS 陀螺仪组合测量系统信号融合的方法.《天津大学学报(自然科学与工程技术版)》.2018,第51卷(第2期),第159-166页. *
苏扬 等.基于FPGA 的积分梳状滤波器的设计与研究.《武汉理工大学学报》.2009,第31卷(第20期),第113-116页. *
金钊 等.一种基于卡尔曼滤波的姿态信息融合方法.《北京信息科技大学学报》.2015,第30卷(第1期),第85-89页. *

Also Published As

Publication number Publication date
CN110793517A (en) 2020-02-14

Similar Documents

Publication Publication Date Title
CN109521448B (en) Satellite-borne navigation receiver positioning time service method and device based on orbit root number prediction
CN108759845B (en) Optimization method based on low-cost multi-sensor combined navigation
CN107024212B (en) A kind of deep space probe X-ray pulsar/time difference astronomy doppler combined navigation method
CN107024211B (en) A kind of deep space probe angle measurement/differential speed measuring/difference ranges Combinated navigation method
CN110793517B (en) Broadband micro angular velocity measurement method based on multi-rate fusion technology
CN108919283B (en) Satellite autonomous non-cooperative target relative navigation method and system
Khalaf et al. Novel adaptive UKF for tightly-coupled INS/GPS integration with experimental validation on an UAV
CN106840155B (en) MHD angular velocity sensor and high-precision gyroscope combined measuring method
Anbu et al. Integration of inertial navigation system with global positioning system using extended kalman filter
Xu et al. An improved adaptive Sage filter with applications in GEO orbit determination and GPS kinematic positioning
CN110554443A (en) Method for determining earth gravity field based on carrier phase observed value and point acceleration method
CN113203414B (en) Train positioning method based on GPS+BDS PPP/IMU tight combination
CN107421533B (en) A kind of deep space probe X-ray pulsar TOA/DTOA Combinated navigation method
Iwata et al. High-bandwidth attitude determination using jitter measurements and optimal filtering
CN1122173C (en) Combined geomagnetism aided navigation equipment
CN114370930A (en) Method for measuring satellite structure micro-angle vibration by using MHD micro-angle vibration sensor
CN111578931B (en) High-dynamic aircraft autonomous attitude estimation method based on online rolling time domain estimation
CN113008229A (en) Distributed autonomous integrated navigation method based on low-cost vehicle-mounted sensor
Ji et al. Adaptive Kalman filter enhanced with spectrum analysis for wide-bandwidth angular velocity estimation fusion
Hou et al. A dual-satellite GNSS positioning algorithm of high accuracy in incomplete condition
CN107084726B (en) A kind of celestial self-navigation method based on sun concussion time delay
CN115077535B (en) Non-cooperative spacecraft orbit real-time determination method based on space-ground based collaborative filtering
CN115113646A (en) Satellite formation flat root state continuous estimation method and system based on Kalman filtering
CN112051595A (en) Backward differential filtering method for solving motion acceleration of carrier by utilizing DGPS (differential global positioning system) position information
CN116222541A (en) Intelligent multi-source integrated navigation method and device using factor graph

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
GR01 Patent grant
GR01 Patent grant