CN101122637A - An Adaptive Dimensionality Reduction Filtering Method for SINS/GPS Integrated Navigation for SAR Motion Compensation - Google Patents

An Adaptive Dimensionality Reduction Filtering Method for SINS/GPS Integrated Navigation for SAR Motion Compensation Download PDF

Info

Publication number
CN101122637A
CN101122637A CNA2007101208153A CN200710120815A CN101122637A CN 101122637 A CN101122637 A CN 101122637A CN A2007101208153 A CNA2007101208153 A CN A2007101208153A CN 200710120815 A CN200710120815 A CN 200710120815A CN 101122637 A CN101122637 A CN 101122637A
Authority
CN
China
Prior art keywords
dimensional
sar
sins
uniform
state
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
Application number
CNA2007101208153A
Other languages
Chinese (zh)
Other versions
CN100498373C (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.)
Beihang University
Original Assignee
Beihang 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 Beihang University filed Critical Beihang University
Priority to CNB2007101208153A priority Critical patent/CN100498373C/en
Publication of CN101122637A publication Critical patent/CN101122637A/en
Application granted granted Critical
Publication of CN100498373C publication Critical patent/CN100498373C/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Position Fixing By Use Of Radio Waves (AREA)
  • Navigation (AREA)

Abstract

一种SAR(合成孔径雷达)运动补偿用SINS(捷联惯导)/GPS组合导航系统自适应降维滤波方法,该方法离线建立不同飞行机动情况的全维SINS/GPS组合导航滤波模型库;载机机动性发生变化时在线计算每个状态变量可观测度;依据可观测度从大到小排列状态变量,选择包含三维位置和速度在内的前d维状态变量建立最小维数降维滤波模型,采用随机生成法确定状态估计方差矩阵中新增状态变量对应的元素。在载机机动性下一次发生变化之前采用所建立的降维滤波器实现组合导航。本发明利用状态变量可观测度与估计精度之间的对应关系构建自适应降维滤波模型,在保证滤波精度的同时显著提高了系统实时性。

A kind of SAR (Synthetic Aperture Radar) motion compensation uses SINS (strapdown inertial navigation)/GPS integrated navigation system self-adaptive dimensionality reduction filter method, this method establishes the full-dimensional SINS/GPS integrated navigation filter model library of different flight maneuvers off-line; Calculate the observability of each state variable online when the maneuverability of the carrier aircraft changes; arrange the state variables from large to small according to the observability, and select the first d-dimensional state variables including the three-dimensional position and velocity to establish the minimum dimensionality reduction filter The model uses the random generation method to determine the elements corresponding to the newly added state variables in the state estimation variance matrix. Before the next change of the aircraft's maneuverability, the established dimensionality reduction filter is used to realize integrated navigation. The invention utilizes the corresponding relationship between the observability of the state variable and the estimation accuracy to construct an adaptive dimensionality reduction filtering model, which notably improves the real-time performance of the system while ensuring the filtering accuracy.

Description

SINS/GPS combined navigation self-adaptive dimensionality reduction filtering method for SAR motion compensation
Technical Field
The invention relates to a SINS (Strapdown Inertial Navigation) and GPS (global positioning System) combined Navigation self-adaptive dimension reduction filtering method for SAR (Synthetic Aperture Radar) motion compensation, in particular to a self-adaptive dimension reduction filtering model, which is particularly suitable for occasions such as real-time online measurement of SAR imaging System antenna phase center motion parameters.
Background
The SAR high-resolution remote sensing imaging has the advantages of all-weather imaging, penetrating imaging, stereo imaging and the like, has important application in the fields of battlefield reconnaissance, global real-time early warning, land resource mapping, environmental monitoring and protection, climate and natural disaster monitoring and early warning and the like, and is military and civil dual-purpose high-technology equipment for realizing earth observation. The SAR technology has been developed from a post-hoc imaging mode to a real-time imaging, real-time transmission mode. The precondition of SAR imaging is that three-dimensional position information of the antenna phase center must be accurately measured during the imaging process. Therefore, SAR real-time imaging needs to break through the technical bottleneck of real-time and high-precision measurement of the three-dimensional position of the phase center of the antenna urgently, and the SAR real-time imaging is called as an SAR real-time motion compensation technology.
The traditional SAR motion compensation scheme adopts an SINS/GPS integrated navigation system to measure the motion parameters of an antenna phase center, and the SINS/GPS integrated navigation system generally constructs a Kalman filtering model containing 15-dimensional state variables and 6-dimensional observation variables. Because the dimension of the filter model is higher, the multiplication and addition times of one-step filtering are 15 3 +6×15 2 The system is difficult to solve the position information of the SAR antenna phase center in real time, and generally, the system acquires original information in real time, processes the original information in real time to obtain the position information of the SAR antenna phase center and provides motion compensation parameters for the SAR system imaging in real time. The invention provides a self-adaptive dimension reduction filtering method of an SINS/GPS combined navigation system for SAR motion compensation, which aims to provide three-dimensional position information of an antenna phase center for an SAR real-time imaging system.
Disclosure of Invention
The technical problem to be solved by the invention is as follows: the method overcomes the defects of the prior art, provides a SINS/GPS combined navigation self-adaptive dimension reduction filtering method with high precision and good real-time performance, and provides three-dimensional position information of an antenna phase center for an SAR real-time imaging system on line.
The technical solution of the invention is as follows: an adaptive dimensionality reduction filtering method of an SINS/GPS integrated navigation system for SAR motion compensation is characterized by comprising the following steps: (1) Establishing a full-dimensional (15-dimensional) filtering model base in an off-line manner, wherein the full-dimensional (15-dimensional) filtering model base comprises a state equation, an observation equation, a system noise variance array, a measurement noise variance array and a state estimation variance array of models under three different flight maneuver conditions; the three filtering models respectively correspond to three conditions of uniform linear motion, uniform accelerated linear motion and uniform circular motion of the SAR loader. (2) The system starts to work, judges that the maneuverability of the carrier changes, utilizes a state transition matrix, an observation matrix and an observability degree analyzing and calculating method based on a singular value decomposition principle on line in real time to calculate the observability degree of the 15-dimensional state variables, and rearranges the state variables from large to small according to the observability degree. (3) Selecting front d-dimensional state variables including three-dimensional positions and speeds to form a dimensionality reduction filtering model with the minimum dimensionality, wherein d is equal to the maximum arrangement serial number corresponding to the three-dimensional positions and the speed state variables; (4) Determining elements corresponding to newly added state variables in a state estimation variance matrix of the newly built dimension reduction filtering model by adopting a random generation method; (5) And starting and maintaining the dimension reduction filtering model until the mobility of the SAR aerial carrier changes again.
The principle of the invention is as follows: the filtering precision of each state variable in the SINS/GPS combined navigation system filtering model changes along with the change of the aircraft mobility of the SAR aircraft, and the observability degree quantitatively represents the filtering precision of each state variable under the current aircraft mobility condition. The SINS/GPS combined navigation self-adaptive dimension reduction filtering method for SAR motion compensation calculates the observability degree of each state variable in the current maneuvering state when the maneuvering characteristics of the SAR carrier change, and the state variables are sequenced from large to small according to the observability degree. And selecting the front d-dimensional state variables including the three-dimensional position and the speed from large to small to construct a dimensional minimum filtering model, wherein n is equal to the maximum arrangement serial number corresponding to the three-dimensional position and speed state variables. Determining a state transition matrix, a system noise variance matrix and a state estimation variance matrix corresponding to the dimensionality reduction filtering model, and finishing combined navigation filtering; and determining elements corresponding to the new supplementary state variables in the state estimation variance matrix by adopting a random generation method. And when the flight mobility of the SAR aerial carrier does not change, the current SINS/GPS combined navigation filtering model is kept. According to the invention, the calculated amount is greatly reduced by constructing the self-adaptive dimensionality reduction filtering model in real time and deleting the state variable with poor filtering precision on line; and meanwhile, high filtering precision state variables required by SAR imaging are saved. Although certain calculation cost is needed for calculating the observability of the state variables in real time on line and constructing the dimension reduction filtering model, considering that SAR imaging requires that the carrier keeps constant-speed linear motion under most conditions, as shown in FIG. 1, the time for the change of the mobility of the SAR carrier is not much, so that the method achieves the purpose of obviously reducing the overall calculation amount of the adaptive dimension reduction filtering model of the SINS/GPS combined navigation system for SAR motion compensation by using smaller calculation cost, namely calculating the observability of the state variables and constructing the dimension reduction filtering model, ensures the filtering precision same as that of the full-dimension filtering model, and meets the requirements of the SAR real-time imaging system.
Compared with the prior art, the invention has the advantages that: hair brushThe self-adaptive dimensionality reduction filtering method is adopted, so that the SINS/GPS combined navigation system for SAR motion compensation can ensure the filtering precision, obviously reduce the calculated amount and lay the technical foundation for the SAR real-time imaging system. This is due to: (1) Compared with the traditional SINS/GPS integrated navigation system filtering method, the filtering method disclosed by the invention has the advantages that the state variables are adaptively selected or rejected on line according to the observable degree of the system state variables to form a dimension reduction filtering model, and the state variables with poor filtering precision are abandoned, so that the precision of the filtering method is not influenced completely; (2)The calculation amount is reduced remarkably; because the filtering model dimension has great influence on the system calculation amount, n and m are assumed to be the dimensions of the state variable and the observation variable respectively, and the multiplication and addition times of one-step filtering are n 3 +m×n 2 . The self-adaptive dimension reduction filtering model provided by the invention mainly aims to reduce the dimension of the SINS/GPS combined navigation filtering model for SAR motion compensation, thereby achieving the purpose of reducing the calculated amount; (3) An SINS/GPS combined navigation filtering model library under different flight mobility conditions of an SAR carrier is established, the observable degree of state variables is calculated on line in real time, and a dimension reduction filtering model is constructed only by selecting from the model library, so that the system flow is greatly simplified; (4) And determining new supplementary elements in the state estimation variance matrix by adopting a random generation method when the SINS/GPS combined navigation filtering model is reconstructed on line every time. The random generation method has small calculation amount and high correlation degree with the variance of the last filtering value, and is favorable for quick convergence of the reconstructed dimension reduction filtering model.
Drawings
FIG. 1 is a typical rout-path diagram for a SAR aerial vehicle of the present invention;
FIG. 2 is a schematic diagram of a state variable sorting and selecting process according to the present invention;
FIG. 3 is a flowchart of the method operation of the present invention.
Detailed Description
As shown in fig. 3, the specific steps of the present invention are as follows:
(1) Firstly, constructing a full-dimensional SINS/GPS integrated navigation system filtering model library, comprising the following steps: three models of uniform linear motion, uniform accelerated linear motion and uniform circular motion.
a. The uniform circular motion full-dimensional SINS/GPS integrated navigation system filter model:
15 dimensional state variable
X(t)=[φ x φ y φ z δv x δv y δv z δL δλ δh ε x ε y ε zxyz ] T The state equation of the SINS/GPS integrated navigation system is as follows:
Figure A20071012081500061
the measurement equation is as follows:
Z(t)=H(t)X(t)+V(t)
wherein F (t) is the state transition matrix of the system:
Figure A20071012081500062
F N is determined by the coefficients of the following set of differential equations:
Figure A20071012081500073
Figure A20071012081500074
Figure A20071012081500075
Figure A20071012081500076
Figure A20071012081500077
Figure A20071012081500078
Figure A20071012081500079
l and delta L are latitude and latitude estimation errors respectively; λ, δ λ are longitude and longitude estimation errors, respectively; h, δ h are height and height estimation errors, respectively; v x ,δv x ,v y ,δv y ,v z ,δv z Estimating errors for the three weft speeds and the speed respectively; phi is a x ,φ y ,φ z Respectively estimating errors of the three-dimensional postures; epsilon x ,ε y ,ε z Respectively, three-axis gyro errors; v x ,▽ y ,▽ z Respectively, errors of a triaxial accelerometer; f. of x ,f y ,f z Respectively measuring the three-axis specific force;  x , y , z The pitch angle, the roll angle and the yaw angle of the SAR aerial carrier are respectively; r m ,R n ,ω ie The radius of the prime plane is the radius of the prime plane, and the rotation angular velocity of the earth.
G (t) is a system noise transfer matrix:
Figure A200710120815000712
wherein:
Figure A200710120815000713
w (t) is the random error of the gyroscope and accelerometer, W (t) = [ W = εx w εy w εz w ▽x w ▽y w ▽z ] T . Observation matrix
Figure A20071012081500081
H v =[0 3×3 diag(1 1 1) 0 3×12 ]
H p =[0 3×6 diag(R m R n cosL 1) 0 3×9 ]
Observation vector Z (t) = [ δ v = x δv y δv z δL δλ δh] T
The system noise variance matrix Q is represented by W (t) = [ W εx w εy w εz w ▽x w ▽y w ▽z ] T The variances of the individual elements constitute a diagonal matrix of diagonal elements. The measurement noise variance matrix R is formed by Z (t) = [ delta v = x δv y δv z δL δλ δh] T The variance of each element constitutes a diagonal matrix of diagonal elements. The initial value of the state estimation variance matrix is determined as a 15-dimensional unit matrix, and the matrix is updated in real time according to the conventional Kalman filtering step in each subsequent combined filtering process.
All the parameters used in the formula are navigation parameters at the current moment, and are regarded as constant values in each filtering step.
b. Compared with uniform circular motion, the SINS/GPS integrated navigation system filtering model of uniform acceleration and uniform linear motion only forms a state transition matrix F N Are different.
The filtering model of the uniform acceleration linear motion full-dimensional SINS/GPS integrated navigation system is at a constant speedOrder v on the basis of circular motion filtering model z =0, and thus omitted
Figure A20071012081500082
In
Figure A20071012081500083
ie sinLv z A term of delta L and a term of delta L,
Figure A20071012081500084
in (1)
Figure A20071012081500085
Item (1):
15 dimensional state variable
X(t)=[φ x φ y φ z δv x δv y δv z δL δλ δh ε x ε y ε zx ▽y ▽ z ] T
The state equation of the SINS/GPS integrated navigation system is as follows:
Figure A20071012081500086
the measurement equation is:
Z(t)=H(t)X(t)+V(t)
wherein F (t) is the state transition matrix of the system:
Figure A20071012081500087
F N is determined by the coefficients of the following set of differential equations:
Figure A20071012081500091
Figure A20071012081500092
Figure A20071012081500094
Figure A20071012081500095
Figure A20071012081500096
Figure A20071012081500097
Figure A20071012081500099
Figure A200710120815000910
Figure A200710120815000911
l and delta L are latitude and latitude estimation errors respectively; λ, δ λ are longitude and longitude estimation errors, respectively; h, δ h are height and height estimation errors, respectively; v. of x ,δv x ,v y ,δv y ,δv z Estimating errors for the three weft speeds and the speed respectively; phi is a x ,φ y ,φ z Respectively estimating errors of the three-dimensional postures; epsilon x ,ε y ,ε z Respectively, three-axis gyro errors; v x ,▽ y ,▽ z Respectively, errors of a triaxial accelerometer; f. of x ,f y ,f z Are respectively provided withIs a triaxial specific force measurement;  x , y , z The pitch angle, the roll angle and the yaw angle of the SAR aerial carrier are respectively; r M ,R n ,ω ie The radius of the prime plane is the radius of the prime plane, and the rotation angular velocity of the earth.
G (t) is a system noise transfer matrix:
Figure A200710120815000912
wherein:
Figure A200710120815000913
w (t) is the random error of the gyroscope and accelerometer,
W(t)=[w εx w εy w εz w ▽x w ▽y w ▽z ] T . Observation matrix
Figure A20071012081500101
H v =[0 3×3 diag(1 1 1) 0 3×12 ], H p =[0 3×6 diag(R m R n cosL 1) 0 3×9 ]
Observation vector Z (t) = [ δ v = x δv y δv z δL δλ δh] T
The system noise variance matrix Q is represented by W (t) = [ W εx w εy w εz w ▽x w ▽y w ▽z ] T The variances of the individual elements constitute a diagonal matrix of diagonal elements. The measurement noise variance matrix R is formed by Z (t) = [ delta v = x δv y δv z δL δλ δh] T The variance of each element constitutes a diagonal matrix of diagonal elements. The initial value of the state estimation variance matrix is determined as a 15-dimensional unit matrix, and the matrix is updated in real time according to the conventional Kalman filtering step in each subsequent combined filtering process. All the parameters used in the formula are navigation parameters of the current moment, and filtering is carried out at each stepThe wave is considered to be a constant value.
c. The filtering model of the uniform linear motion full-dimensional SINS/GPS integrated navigation system is based on the uniform circular motion filtering model z =0,f x =f y =f z =0, and thus omitted
Figure A20071012081500102
In (1)
Figure A20071012081500103
ie sin Lv z δL、 f y φ z -f z φ y
Figure A20071012081500104
F in (1) z φ x -f x φ z
Figure A20071012081500105
Figure A20071012081500106
F in (1) x φ y -f y φ x -and the like: 15 dimensional state variable
X(t)=[φ x φ y φ z δv x δv y δv z δL δλ δh ε x ε y ε zxyz ] T The state equation of the SINS/GPS integrated navigation system is as follows:
the measurement equation is:
Z(t)=H(t)X(t)+V(t)
wherein F (t) is the state transition matrix of the system:
F N is determined by the coefficients of the following set of differential equations:
Figure A20071012081500109
Figure A200710120815001010
Figure A20071012081500111
Figure A20071012081500112
Figure A20071012081500113
Figure A20071012081500114
Figure A20071012081500115
Figure A20071012081500116
Figure A20071012081500117
Figure A20071012081500118
l and delta L are latitude and latitude estimation errors respectively; λ, δ λ are longitude and longitude estimation errors, respectively; h, δ h are height and height estimation errors, respectively; v. of x ,δv x ,v y ,δv y ,δ z ,δv z Estimating errors for the three weft speeds and the speed respectively; phi is a x ,φ y ,φ z Respectively estimating errors of the three-dimensional postures; epsilon x ,ε y ,ε z Respectively, three-axis gyro errors; v x ,▽ y ,▽ z Respectively, the errors of the three-axis accelerometer; f. of x ,f y ,f z Respectively measuring the three-axis specific force;  x , y , z The pitch angle, the roll angle and the yaw angle of the SAR aerial carrier are respectively; r m ,R n ,ω ie The radius of the prime plane is the radius of the prime plane, and the rotation angular velocity of the earth.
G (t) is a system noise transfer matrix:
Figure A20071012081500119
wherein:
Figure A200710120815001110
w (t) is the random error of the gyroscope and accelerometer, W (t) = [ W = εx w εy w εz w ▽x w ▽y w ▽z ] T . Observation matrixH v =[0 3×3 diag(1 1 1) 0 3×12 ],
H p =[0 3×6 diag(R m R n cosL 1) 0 3×9 ]
Observation vector Z (t) = [ δ v = x δv y δv z δL δλ δ h ] T
The system noise variance matrix Q is represented by W (t) = [ W εx w εy w εz w ▽x w ▽y w ▽z ] T The variance of each element constitutes a pairA diagonal matrix of diagonal elements. The measurement noise variance matrix R is formed by Z (t) = [ delta v = x δv y δv z δL δλ δh] T The variance of each element constitutes a diagonal matrix of diagonal elements. The initial value of the state estimation variance matrix is determined as a 15-dimensional unit matrix, and the matrix is updated in real time according to the conventional Kalman filtering step in each subsequent combined filtering process. All the parameters used in the formula are navigation parameters at the current moment, and are regarded as constant values in each filtering step.
(2) Secondly, the system starts to work, judges the mobility change of the carrier, identifies the current motion of the carrier as one of three conditions of uniform linear motion, uniform accelerated linear motion or uniform circular motion, calculates the observability degree on line in real time, and rearranges the state variables according to the observability degree from large to small.
When the output of the three-dimensional accelerometer is smaller than a specified threshold, the three-dimensional accelerometer is judged to be uniform-speed linear motion, when the vector sum of the three-dimensional accelerometer keeps a constant value, the three-dimensional accelerometer is judged to be uniform-speed linear motion, and when the vector sum of the three-dimensional accelerometer keeps a constant value, the three-dimensional accelerometer is judged to be uniform-speed circular motion. The period of judgment is the same as the filtering period, and is 1 second. The output judgment threshold of the accelerometer is determined by the sensitivity of the accelerometer selected by the system.
Calculating the observability degree of all 15-dimensional state variables under the condition of uniform linear motion, uniform accelerated linear motion or uniform circular motion so as to ensure that
Figure A20071012081500121
And carrying out singular value decomposition on the T array to obtain:
T=U*S*V T
wherein: u = [ U = 1 u 2 ...u m ],V=[v 1 v 2 ...v n ]Are all orthogonal matrices and are provided with a plurality of parallel,
Figure A20071012081500122
is a matrix of order m × r, where Λ = diag (σ) 1 σ 2 ... σ r ) Is a diagonal matrix, σ 1 ≥σ 2 ≥...≥σ r ≧ 0 is referred to as the singularity of the matrix T. According to the size of the singular value, whether the corresponding state variable can be observed or not can be judged, the observability of which state variables is high, and the observability of which variables is low.
(3) And sequencing the state variables from large to small according to the observability degree, and taking the front d-dimensional state variables including the three-dimensional position and the three-dimensional speed to form a state vector of the minimum-dimension filtering model. As shown in fig. 2.
(4) And determining elements corresponding to the newly-added state variables in the state estimation variance matrix of the newly-built dimension reduction filtering model by adopting a random generation method.
Constructing a dimension-reduction filtering model according to the determined state variables, wherein a full dimension corresponding to the mobility of the current SAR aerial carrier is adoptedBased on the SINS/GPS combined navigation filtering model, only elements corresponding to state variables contained in the dimensionality reduction filtering model in a state transition matrix F (t), a system noise transition matrix G (t) and an observation matrix H (t) are reserved; taking the corresponding element of the state estimation variance matrix of the state variable contained in the last estimation dimension reduction filtering model as the mean value, and taking the observability sigma of the variable at the last estimation time prev Observable degree sigma of current time now Is the variance of
Figure A20071012081500131
And determining an element corresponding to the state variable in the filtering variance matrix at the current moment, namely the estimation variance of the newly added state variable.
(5) And under the condition that the maneuverability of the current SAR aerial carrier is kept unchanged, the dimension reduction filtering model is kept to realize SAR motion compensation. And restarting to calculate the observability measure when the mobility of the SAR aerial carrier is changed.
The steps are circularly carried out, as shown in fig. 3, the SINS/GPS combined navigation self-adaptive dimensionality reduction filtering method for SAR motion compensation can be realized, and the calculated amount is greatly reduced while the filtering precision is ensured.

Claims (5)

1. An adaptive dimension reduction filtering method of an SINS/GPS integrated navigation system for SAR motion compensation is characterized by comprising the following steps:
(1) Establishing a full-dimensional, namely 15-dimensional filtering model base in an off-line manner, wherein the full-dimensional, namely 15-dimensional filtering model base comprises a state equation, an observation equation, a system noise variance matrix, a measurement noise variance matrix and a state estimation variance matrix of models under three different flight maneuvering conditions of SAR carrier uniform linear motion, uniform acceleration linear motion and uniform circular motion;
(2) The system starts to work, judges the mobility change of the carrier, identifies the current motion of the carrier as one of three conditions of uniform linear motion, uniform accelerated linear motion or uniform circular motion, calculates the observability degree on line in real time, and rearranges the state variables according to the observability degree from large to small;
(3) Selecting front d-dimensional state variables including three-dimensional positions and three-dimensional speeds to form a dimensionality reduction filtering model with the minimum dimensionality, wherein d is equal to the maximum arrangement serial number corresponding to the three-dimensional positions and the speed state variables;
(4) Determining elements corresponding to newly-added state variables in a state estimation variance matrix of the newly-built dimension reduction filtering model by adopting a random generation method;
(5) And starting and maintaining the dimension reduction filtering model until the mobility of the SAR aerial carrier changes again.
2. The adaptive dimension reduction filtering method for the SINS/GPS integrated navigation system for SAR motion compensation according to claim 1, wherein: the method for identifying whether the current motion of the carrier is uniform linear motion, uniform acceleration linear motion or uniform circular motion in the step (2) comprises the following steps: when the output of the three-dimensional accelerometer is smaller than a specified threshold, the three-dimensional accelerometer is judged to be in uniform-speed linear motion, when the vector sum of the three-dimensional accelerometer keeps a constant value, the three-dimensional accelerometer is judged to be in uniform-speed linear motion, and when the vector sum of the three-dimensional accelerometer keeps the constant value, the three-dimensional accelerometer is judged to be in uniform-speed circular motion.
3. The adaptive dimension reduction filtering method for the SINS/GPS integrated navigation system for SAR motion compensation according to claim 1, wherein: the method for calculating the observability measure in the step (2) comprises the following steps: and calculating the observability of the 15-dimensional state variable by using a state transition matrix, an observation matrix and an observability degree analysis calculation method based on a singular value decomposition principle.
4. The adaptive dimension reduction filtering method for the SINS/GPS integrated navigation system for SAR motion compensation according to claim 1, wherein: and (4) the dimension reduction filtering model in the step (3) is a minimum dimension filtering model formed by taking the front d-dimension state variables including three-dimensional position information and three-dimensional speed information after the state variables are sequenced from large to small according to the observability degree.
5. The adaptive dimension reduction filtering method for the SINS/GPS integrated navigation system for SAR motion compensation according to claim 1, wherein: the random generation method in step (4) is to estimate the time of the variable for the last timeTaking corresponding elements of the state estimation variance matrix as mean values, and according to the observability degree sigma of the variable at the last estimation moment prev Observable with the current time instant by a now Is the variance of
Figure A2007101208150003C1
And determining the element corresponding to the state variable in the filtering variance matrix at the current moment.
CNB2007101208153A 2007-08-27 2007-08-27 SINS/GPS combined navigation self-adaptive reduced-dimensions filtering method for SAR movement compensation Expired - Fee Related CN100498373C (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CNB2007101208153A CN100498373C (en) 2007-08-27 2007-08-27 SINS/GPS combined navigation self-adaptive reduced-dimensions filtering method for SAR movement compensation

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CNB2007101208153A CN100498373C (en) 2007-08-27 2007-08-27 SINS/GPS combined navigation self-adaptive reduced-dimensions filtering method for SAR movement compensation

Publications (2)

Publication Number Publication Date
CN101122637A true CN101122637A (en) 2008-02-13
CN100498373C CN100498373C (en) 2009-06-10

Family

ID=39085053

Family Applications (1)

Application Number Title Priority Date Filing Date
CNB2007101208153A Expired - Fee Related CN100498373C (en) 2007-08-27 2007-08-27 SINS/GPS combined navigation self-adaptive reduced-dimensions filtering method for SAR movement compensation

Country Status (1)

Country Link
CN (1) CN100498373C (en)

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102075295A (en) * 2011-01-20 2011-05-25 浙江大学 Communication power constraint-based state estimation-targeted encoding and decoding method
CN102299766A (en) * 2011-08-18 2011-12-28 浙江大学 Joint optimization method for dimensionality reduction and quantification of communication signal for object state estimation
CN102980583A (en) * 2012-12-25 2013-03-20 哈尔滨工业大学 Ballistic missile boosting section tracking method based on dimension-augmenting shifted Rayleigh filtering
CN103649683A (en) * 2011-06-03 2014-03-19 罗伯特·博世有限公司 Combined radar and gps localization system
CN103870714A (en) * 2014-04-03 2014-06-18 武汉科技大学 Navigation system observable analysis method based on high-order observable matrix
CN105158784A (en) * 2015-07-07 2015-12-16 中国人民解放军第二炮兵工程大学 COTM satellite communication system cascade Kalman filtering carrier attitude estimation method
CN107036598A (en) * 2017-03-30 2017-08-11 南京航空航天大学 Dual quaterion inertia/celestial combined navigation method based on gyro error amendment
CN109270507A (en) * 2018-11-05 2019-01-25 金华航大北斗应用技术有限公司 Error compensation model is moved in GNSS-R Bistatic SAR imager carrying
CN111149018A (en) * 2017-09-26 2020-05-12 焦点定位有限公司 Method and system for calibrating system parameters
CN113607176A (en) * 2021-10-11 2021-11-05 智道网联科技(北京)有限公司 Combined navigation system track output method and device

Cited By (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102075295B (en) * 2011-01-20 2013-02-27 浙江大学 A Signal Encoding and Decoding Method Aiming at State Estimation Based on Communication Power Constraints
CN102075295A (en) * 2011-01-20 2011-05-25 浙江大学 Communication power constraint-based state estimation-targeted encoding and decoding method
CN103649683A (en) * 2011-06-03 2014-03-19 罗伯特·博世有限公司 Combined radar and gps localization system
CN103649683B (en) * 2011-06-03 2016-08-17 罗伯特·博世有限公司 The radar of combination and GPS alignment system
US9562778B2 (en) 2011-06-03 2017-02-07 Robert Bosch Gmbh Combined radar and GPS localization system
CN102299766A (en) * 2011-08-18 2011-12-28 浙江大学 Joint optimization method for dimensionality reduction and quantification of communication signal for object state estimation
CN102299766B (en) * 2011-08-18 2013-10-23 浙江大学 A Joint Optimization Method for Dimensionality Reduction and Quantization of Communication Signals for Target State Estimation
CN102980583A (en) * 2012-12-25 2013-03-20 哈尔滨工业大学 Ballistic missile boosting section tracking method based on dimension-augmenting shifted Rayleigh filtering
CN102980583B (en) * 2012-12-25 2015-03-25 哈尔滨工业大学 Ballistic missile boosting section tracking method based on dimension-augmenting shifted Rayleigh filtering
CN103870714B (en) * 2014-04-03 2017-04-12 武汉科技大学 Navigation system observable analysis method based on high-order observable matrix
CN103870714A (en) * 2014-04-03 2014-06-18 武汉科技大学 Navigation system observable analysis method based on high-order observable matrix
CN105158784A (en) * 2015-07-07 2015-12-16 中国人民解放军第二炮兵工程大学 COTM satellite communication system cascade Kalman filtering carrier attitude estimation method
CN107036598A (en) * 2017-03-30 2017-08-11 南京航空航天大学 Dual quaterion inertia/celestial combined navigation method based on gyro error amendment
CN111149018A (en) * 2017-09-26 2020-05-12 焦点定位有限公司 Method and system for calibrating system parameters
CN111149018B (en) * 2017-09-26 2023-09-15 焦点定位有限公司 Method and system for calibrating system parameters
CN109270507A (en) * 2018-11-05 2019-01-25 金华航大北斗应用技术有限公司 Error compensation model is moved in GNSS-R Bistatic SAR imager carrying
CN109270507B (en) * 2018-11-05 2023-08-15 金华航大北斗应用技术有限公司 GNSS-R bistatic SAR imaging airborne motion error compensation model
CN113607176A (en) * 2021-10-11 2021-11-05 智道网联科技(北京)有限公司 Combined navigation system track output method and device
CN113607176B (en) * 2021-10-11 2021-12-10 智道网联科技(北京)有限公司 Combined navigation system track output method and device

Also Published As

Publication number Publication date
CN100498373C (en) 2009-06-10

Similar Documents

Publication Publication Date Title
CN101122637A (en) An Adaptive Dimensionality Reduction Filtering Method for SINS/GPS Integrated Navigation for SAR Motion Compensation
CN108594283B (en) Free installation method of GNSS/MEMS inertial integrated navigation system
Syed et al. A new multi-position calibration method for MEMS inertial navigation systems
CN110779521A (en) Multi-source fusion high-precision positioning method and device
CN107588769B (en) Vehicle-mounted strapdown inertial navigation, odometer and altimeter integrated navigation method
CN109991636A (en) Map constructing method and system based on GPS, IMU and binocular vision
CN106500693B (en) A kind of AHRS algorithm based on adaptive extended kalman filtering
CN110243377B (en) Cluster aircraft collaborative navigation method based on hierarchical structure
CN103941273B (en) Adaptive filtering method of onboard inertia/satellite integrated navigation system and filter
CN110849360B (en) Distributed relative navigation method for multi-machine collaborative formation flight
CN103675861A (en) Satellite autonomous orbit determination method based on satellite-borne GNSS multiple antennas
CN109708663B (en) Star sensor online calibration method based on aerospace plane SINS assistance
CN103792561B (en) A kind of tight integration reduced-dimensions filtering method based on GNSS passage difference
CN109443349A (en) A kind of posture Course Measure System and its fusion method, storage medium
CN104374388A (en) Flight attitude determining method based on polarized light sensor
CN110207691A (en) A kind of more unmanned vehicle collaborative navigation methods based on data-link ranging
CN106405592B (en) Vehicle-mounted Beidou carrier phase cycle slips detection and restorative procedure and system
CN111189442A (en) Multi-source navigation information state prediction method of unmanned aerial vehicle based on CEPF
CN115327588A (en) A high-precision positioning method for unmanned automatic operation special vehicles based on network RTK
CN104697520A (en) Combined navigation method based on integrated gyroscope free strapdown inertial navigation system and GPS
CN112556724A (en) Initial coarse alignment method for low-cost navigation system of micro aircraft in dynamic environment
CN113008229B (en) Distributed autonomous integrated navigation method based on low-cost vehicle-mounted sensor
RU2277696C2 (en) Integrated satellite inertial-navigational system
CN110873577B (en) A kind of underwater quick-moving base alignment method and device
Geng et al. Hybrid derivative-free EKF for USBL/INS tightly-coupled integration in AUV

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

Granted publication date: 20090610

Termination date: 20180827

CF01 Termination of patent right due to non-payment of annual fee