CN102032922A - Inertial-navigation quick and initial alignment method under robust optimal significance - Google Patents
Inertial-navigation quick and initial alignment method under robust optimal significance Download PDFInfo
- Publication number
- CN102032922A CN102032922A CN2010105680906A CN201010568090A CN102032922A CN 102032922 A CN102032922 A CN 102032922A CN 2010105680906 A CN2010105680906 A CN 2010105680906A CN 201010568090 A CN201010568090 A CN 201010568090A CN 102032922 A CN102032922 A CN 102032922A
- Authority
- CN
- China
- Prior art keywords
- initial alignment
- inertial navigation
- matrix
- robust
- phi
- 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
Images
Landscapes
- Feedback Control In General (AREA)
Abstract
The invention discloses an inertial-navigation quick and initial alignment method under robust optimal significance, comprising the following steps of: introducing an auxiliary matrix and an auxiliary feedback control vector into an initial alignment system; solving a robust optimal control problem according to a maxmin index, determining a state feedback control matrix; and in an initial alignment process, recursively calculating a state vector in an error equation of an inertial-navigation system in real time by using an improved H infinite filter, forming a closed loop after feedback, and obtaining three misalignment angles after converging the system. The inertial-navigation quick and initial alignment method has good system structure and good stable parameter robustness, improves dynamic responding quality and increases the initial alignment rapidity of the initial alignment system.
Description
Technical field
The present invention relates to the initial alignment technology in inertial navigation field, relate to robust control theory simultaneously.
Background technology
Initial alignment is one of the gordian technique in inertial navigation field.Initial alignment is meant that inertial navigation system formally enters before the duty, platform coordinate system and the navigation coordinate system that selectes are coincided, for navigation calculation provides necessary starting condition, comprise alignment precision and aligning time two important indicators, it has a direct impact the later serviceability of system.
Because the observability of partial status variable is poor, it is long that traditional initial alignment method is aimed at the time.And reduce the initial alignment time rapidity that improves the armament systems response is extremely important.
Kalman wave filter commonly used is estimated the error state vector in the initial alignment.But the Kalman wave filter requires that the model of system is accurate, noise statistics is known and satisfies the assumed condition of correlativity.During practical application, but exist the external interference signals that statistical property is short in understanding in the system, and there is the perturbation in the certain limit in system model itself.
At the problems such as uncertainty of initial alignment time length, filtering system, the present invention is with L
2The uncertain robust theory of optimal control of bounded and H
∞Wave filter is introduced the initial alignment process of inertial navigation system, solves with a kind of new thinking and method.
Summary of the invention
The purpose of this invention is to provide a kind of inertial navigation system fast initial alignment method with robust optimal performance.
The implementation procedure of initial alignment is as follows:
A: according to the mathematical model of inertial navigation system error state equation
Select auxiliary FEEDBACK CONTROL vector u, determine companion matrix B
1
B: utilize L
2The theory of bounded uncertain system linear quadratic robust optimum control is asked for feedback of status and is separated, and determines state feedback matrix K
1
C: in initial alignment process, utilize improved H
∞The real-time recursion of wave filter is calculated the error state vector of inertial navigation system;
D:H
∞Error state vector estimated value and state feedback matrix K that wave filter obtains
1Multiply each other, feed back to the initial alignment loop, form closed-loop control system;
E: obtain three misalignment φ after system's convergence
E, φ
N, φ
UFor strapdown inertial navitation system (SINS), revise the strapdown matrix, finished the initial alignment of mathematical platform.
According to this method, the selection of matrix must meet the following conditions among the step a: (A, B
1) can control or can calm, (A C) can see, and (A Q) can see.
According to this method, need real symmetric matrix P of structure among the step b, make state feedback matrix
Real symmetric matrix P and selected parameter η need satisfy algebraic riccati equation:
PA+A
TP+Q-P(B
1B
1 T-B
2η
-1B
2 T)P=0。
Parameter η span 0<η<1 wherein.
Real symmetric matrix P and selected parameter η, matrix U (η) need satisfy the Lyapunov equation:
[A-(B
1B
1 T-B
2η
-1B
2 T)P]TU(η)+U(η)[A-(B
1B
1 T-B
2η
-1B
2 T)P]+[η
-1B
2 TP]
T[η
-1B
2 TP]=0。
According to this implementation method, among the step c improved H is adopted in the estimation of error state vector
∞Filtering algorithm.
After the inertial navigation system error state equation is discrete
L in the linear combination herein
kCan be taken as unit matrix I.
Improved H
∞Filtering algorithm is:
Improved H
∞In the wave filter, adopt factor matrix S to guarantee the stability of structure and parameter in the filtering.
According to this method, in the steps d, the auxiliary FEEDBACK CONTROL vector u=K linear with inertial navigation system error state vector x introduced in the initial alignment loop
1X forms closed-loop control system.This control system does not have actual electronic circuit, and the initial alignment loop is realized by computer program.
Obtain the horizontal misalignment φ of east orientation after system's convergence
E, the horizontal misalignment φ of north orientation
NWith the sky to orientation misalignment φ
U
Advantage or beneficial effect that initial alignment method of the present invention has:
(1) reduce the initial alignment time, outstanding tool is that the sky is to orientation misalignment φ
UCan restrain quickly and stablize;
(2) the filtering algorithm structure and parameter is stable, and output is had smoothing effect preferably;
(3) there is good anti-interference and anti-model perturbation ability in the initial alignment system of Shi Xianing;
(4) parameter designing is flexible.
Description of drawings
Fig. 1 is the initial alignment design cycle;
Fig. 2 is the initial alignment frame principle figure;
Fig. 3 is that the feedback of status of the uncertain robust optimum control of L2 bounded is separated and found the solution process flow diagram;
Fig. 4 is the closed-loop control system synoptic diagram in initial alignment loop.
Embodiment
In order to make technical matters of the present invention, solution, technical thought, technical scheme clearer, be described in further detail below with reference to the implementation procedure of accompanying drawing to the inertial navigation system fast initial alignment.
The initial alignment that the present invention relates to is that the inertial navigation system Navigator enters the critical process of navigator fix before resolving, and has represented the full accuracy of navigational system work.As shown in Figure 1, the design process of initial alignment comprises following committed step: at first, determine inertial navigation system error state equation, auxiliary control vector u, companion matrix B
1With the maxmin index; Secondly, utilize the robust theory of optimal control to find the solution and determine state feedback matrix K
1Then, select factor matrix S, to H
∞Wave filter improves; At last, the closed-loop control system of carrying out the initial alignment loop realizes.
Concrete implementation in the design cycle:
(1) determines inertial navigation system error state equation, auxiliary control vector, companion matrix and maxmin index
The error state variable is got east orientation velocity error, north orientation velocity error, the horizontal misalignment of east orientation, the horizontal misalignment of north orientation, sky to the orientation misalignment, i.e. x=[δ V
E, δ V
N, φ
E, φ
N, φ
U]
TOutput state vector y=[δ V
E, δ V
N]
TSo it is as follows that the mathematical model of inertial navigation system error state equation is determined:
Auxiliary control vector u and companion matrix B
1All be taken as 5 rank, u=[u
1, u
2, u
3, u
4, u
5]
T, B
1=(b
1ij)
5 * 5, B
2=I.For the side makes design, might as well get-2<b
1ij<2.
The initial state constraint satisfaction of system wherein
Interference constraints satisfies
Constant weight matrices Q is taken as 5 rank unit matrix I during design.
Introduce the thinking of auxiliary control vector according to the inertial navigation system error state equation of determining and initial alignment, the frame principle figure of initial alignment as shown in Figure 2, u=[f
1(x), f
2(x), f
3(x), f
4(x), f
5(x)]
T=f (x) is the auxiliary FEEDBACK CONTROL vector of introducing in order to realize initial alignment, and in robust optimum control feedback, auxiliary FEEDBACK CONTROL vector u and state vector x have linear relationship u=K
1X.
(2) the robust theory of optimal control is found the solution state feedback matrix K under the maxmin index
1
As shown in Figure 3, concrete solution procedure is as follows:
1. system's controllability and controllability are judged: (A, B
1) can control or can calm, (A, C) and (A Q) can see.Must satisfy the constraint condition that the robust optimum control is found the solution;
2. constant η of initial option;
3. find the solution algebraic riccati equation PA+A
TP+Q-P (B
1B
1 T-B
2η
-1B
2 T) P=0, try to achieve real symmetric matrix P;
7. 3.~6. going on foot in the solution procedure has a step not satisfy, and then increases step-length, makes η=η+Δ η, restarts to calculate.
(3) improved H
∞The wave filter recursion is calculated the error state vector in the initial alignment process
Obtain after the inertial navigation system error state equation discretize
L in the linear combination herein
kBe taken as unit matrix I.
At H
∞Increase factor matrix S in the wave filter, be used for guaranteeing the stability of structure and parameter in the filtering, be so improve algorithm:
In the formula
Factor matrix S is taken as diagonal matrix S=diag{s
1, s
2, s
3, s
4, s
5, s
i=1+ β
iβ
iRepresent the size of adjusting range, its span | β
i|<1, β when not doing any adjustment
i=0.If former wave filter ‖ P ‖
2, ‖ K ‖
2Dull in time the rising got β
i<0; If former wave filter ‖ P ‖
2, ‖ K ‖
2Dull in time decline then got β
i>0.In the method for the present invention, factor matrix value-1<β
i<0.
(4) closed-loop control system of initial alignment realizes
The initial Alignment of Inertial Navigation System loop that the inventive method realizes comprises original system, state observer, FEEDBACK CONTROL three parts as shown in Figure 4.With the input of the observation output valve of original system, according to improved H as state observer
∞Wave filter carries out recursion and calculates, and obtains error state vector estimated value; In feedback controller, error state vector estimated value and feedback matrix carry out the linear matrix computing, and controlled vector is as the input of original system, so form a closed-loop control system.
Obtain the horizontal misalignment φ of east orientation after system's convergence
E, the horizontal misalignment φ of north orientation
NWith the sky to orientation misalignment φ
USo obtain
Claims (9)
1. the inertial navigation fast initial alignment method under the optimum meaning of a robust is with L
2The uncertain robust theory of optimal control of bounded and H
∞Wave filter is introduced the initial alignment process of inertial navigation system, it is characterized in that comprising:
A: according to the mathematical model of inertial navigation system error state equation
Select auxiliary FEEDBACK CONTROL vector u, determine companion matrix B
1
B: utilize L
2The theory of bounded uncertain system linear quadratic robust optimum control is asked for feedback of status and is separated, and determines state feedback matrix K
1
C: in initial alignment process, utilize improved H
∞The real-time recursion of wave filter is calculated the error state vector of inertial navigation system;
D:H
∞Error state vector estimated value and state feedback matrix K that wave filter obtains
1Multiply each other, feed back to the initial alignment loop, form closed-loop control system;
E: obtain three misalignment φ after system's convergence
E, θ
N, φ
UFor strapdown inertial navitation system (SINS), revise the strapdown matrix, finish the initial alignment of mathematical platform.
2. the inertial navigation fast initial alignment method under the optimum meaning of a kind of robust as claimed in claim 1 is characterized in that the selection of matrix must meet the following conditions among the described step a: (A, B
1) can control or can calm, (A C) can see, and (A Q) can see.
4. the inertial navigation fast initial alignment method under the optimum meaning of a kind of robust as claimed in claim 3 is characterized in that, described real symmetric matrix P and selected parameter η need satisfy algebraic riccati equation:
PA+A
TP+Q-P(B
1B
1 T-B
2η
-1B
2 T)P=0。
5. the inertial navigation fast initial alignment method under the optimum meaning of a kind of robust as claimed in claim 4 is characterized in that, described real symmetric matrix P and selected parameter η, matrix U (η) need satisfy the Lyapunov equation:
[A-(B
1B
1 T-B
2η
-1B
2 T)P]
TU(η)+U(η)[A-(B
1B
1 T-B
2η
-1B
2 T)P]+[η
-1B
2 TP]
T[η
-1B
2 TP]=0。
6. the inertial navigation fast initial alignment method under the optimum meaning of a kind of robust as claimed in claim 1 is characterized in that, among the described step c improved H is adopted in the estimation of error state vector
∞Filtering algorithm,
The discrete back of inertial navigation system error state equation:
L in the linear combination herein
kCan be taken as unit matrix I,
Improved H
∞Filtering algorithm is:
7. the inertial navigation fast initial alignment method under the optimum meaning of a kind of robust as claimed in claim 6 is characterized in that, adopts factor matrix S to described H
∞Wave filter improves.
8. the inertial navigation fast initial alignment method under the optimum meaning of a kind of robust as claimed in claim 1 is characterized in that, introduce and the linear auxiliary FEEDBACK CONTROL vector of inertial navigation system error state vector in the initial alignment loop in the described steps d.
9. the inertial navigation fast initial alignment method under the optimum meaning of a kind of robust as claimed in claim 1 is characterized in that the control system in the described steps d does not have actual electronic circuit, and described initial alignment loop is realized by computer program.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010105680906A CN102032922A (en) | 2010-12-01 | 2010-12-01 | Inertial-navigation quick and initial alignment method under robust optimal significance |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010105680906A CN102032922A (en) | 2010-12-01 | 2010-12-01 | Inertial-navigation quick and initial alignment method under robust optimal significance |
Publications (1)
Publication Number | Publication Date |
---|---|
CN102032922A true CN102032922A (en) | 2011-04-27 |
Family
ID=43886118
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2010105680906A Pending CN102032922A (en) | 2010-12-01 | 2010-12-01 | Inertial-navigation quick and initial alignment method under robust optimal significance |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102032922A (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103575278A (en) * | 2013-10-08 | 2014-02-12 | 北京理工大学 | Robust filtering method aiming at parameter uncertainty and observation loss |
CN103616026A (en) * | 2013-12-17 | 2014-03-05 | 哈尔滨工程大学 | AUV (Autonomous Underwater Vehicle) manipulating model auxiliary strapdown inertial navigation combined navigation method based on H infinity filtering |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH09318645A (en) * | 1996-05-29 | 1997-12-12 | Japan Aviation Electron Ind Ltd | Self-velocity vector predicting device |
JP2003114272A (en) * | 2001-10-05 | 2003-04-18 | Clarion Co Ltd | Gps receiver utilizing ura for outputting 2drms, 2drms calculating method and car navigation system |
WO2005008180A1 (en) * | 2003-07-03 | 2005-01-27 | Northrop Grumman Corporation | Method and system for improving accuracy of inertial navigation measurements using measured and stored gravity gradients |
CN101246011A (en) * | 2008-03-03 | 2008-08-20 | 北京航空航天大学 | Multi-target multi-sensor information amalgamation method based on convex optimized algorithm |
CN101246012A (en) * | 2008-03-03 | 2008-08-20 | 北京航空航天大学 | Combinated navigation method based on robust dissipation filtering |
US7610123B2 (en) * | 2005-01-04 | 2009-10-27 | Deere & Company | Vision-aided system and method for guiding a vehicle |
CN100575879C (en) * | 2006-09-04 | 2009-12-30 | 南京航空航天大学 | Self-adapting closed loop H ∞ wave filter is to the modification method of the Big Dipper/strap-down navigation system |
-
2010
- 2010-12-01 CN CN2010105680906A patent/CN102032922A/en active Pending
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH09318645A (en) * | 1996-05-29 | 1997-12-12 | Japan Aviation Electron Ind Ltd | Self-velocity vector predicting device |
JP2003114272A (en) * | 2001-10-05 | 2003-04-18 | Clarion Co Ltd | Gps receiver utilizing ura for outputting 2drms, 2drms calculating method and car navigation system |
WO2005008180A1 (en) * | 2003-07-03 | 2005-01-27 | Northrop Grumman Corporation | Method and system for improving accuracy of inertial navigation measurements using measured and stored gravity gradients |
US7610123B2 (en) * | 2005-01-04 | 2009-10-27 | Deere & Company | Vision-aided system and method for guiding a vehicle |
CN100575879C (en) * | 2006-09-04 | 2009-12-30 | 南京航空航天大学 | Self-adapting closed loop H ∞ wave filter is to the modification method of the Big Dipper/strap-down navigation system |
CN101246011A (en) * | 2008-03-03 | 2008-08-20 | 北京航空航天大学 | Multi-target multi-sensor information amalgamation method based on convex optimized algorithm |
CN101246012A (en) * | 2008-03-03 | 2008-08-20 | 北京航空航天大学 | Combinated navigation method based on robust dissipation filtering |
Non-Patent Citations (2)
Title |
---|
戴绍忠: "L2有界不确定性鲁棒最优控制意义下的惯导初始对准", 《兵工学报》 * |
戴绍忠: "动态灰色聚类自适应的H∞滤波算法", 《北京理工大学学报》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103575278A (en) * | 2013-10-08 | 2014-02-12 | 北京理工大学 | Robust filtering method aiming at parameter uncertainty and observation loss |
CN103575278B (en) * | 2013-10-08 | 2016-04-06 | 北京理工大学 | A kind of robust filtering method of losing for parameter uncertainty and observation |
CN103616026A (en) * | 2013-12-17 | 2014-03-05 | 哈尔滨工程大学 | AUV (Autonomous Underwater Vehicle) manipulating model auxiliary strapdown inertial navigation combined navigation method based on H infinity filtering |
CN103616026B (en) * | 2013-12-17 | 2016-05-04 | 哈尔滨工程大学 | A kind of AUV control model based on H ∞ filtering is assisted inertial navigation Combinated navigation method |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103033186B (en) | High-precision integrated navigation positioning method for underwater glider | |
CN103412491B (en) | A kind of Spacecraft feature axis attitude maneuver index time-varying sliding-mode control | |
CN102736518B (en) | Composite anti-interference controller comprising measurement and input time delay for flexible spacecraft | |
CN102538821B (en) | Fast and parameter sectional type self-alignment method for strapdown inertial navigation system | |
CN107690567A (en) | The method being tracked using extended Kalman filter for the navigation to mobile vehicle equipment | |
CN102654772B (en) | Track dip angle inversion controlling method of aircraft based on control force limitation situation | |
CN105652880B (en) | Non-linear anti-saturation for the big spatial domain flight of aircraft highly instructs generation method | |
CN104019817B (en) | A kind of norm constraint strong tracking volume kalman filter method for Satellite Attitude Estimation | |
CN103389095A (en) | Self-adaptive filter method for strapdown inertial/Doppler combined navigation system | |
CN102162733A (en) | Method for correcting autonomous underwater vehicle (AUV) dead reckoning navigation error in real time based on space vector modulation (SVM) | |
CN104121907A (en) | Square root cubature Kalman filter-based aircraft attitude estimation method | |
CN103760827B (en) | The off-line planning method of the digital control processing feed rate of jerk constraint | |
CN105973238A (en) | Spacecraft attitude estimation method based on norm-constrained cubature Kalman filter | |
CN104102836A (en) | Method for quickly estimating robust state of power system | |
CN104266663A (en) | Secondary stable disturbance decoupling method for photoelectric tracking system of motion platform | |
CN108279695A (en) | A kind of quick in-orbit closed-loop identification method, system and the medium of spacecraft disturbance torque | |
CN107168359A (en) | A kind of control method of large-scale flexible satellite high precision high stability degree | |
CN112504298A (en) | GNSS-assisted DVL error calibration method | |
CN103983996A (en) | Tight-integration adaptive filtering method of resisting to outliers of global positioning system, | |
CN101929862A (en) | Method for determining initial attitude of inertial navigation system based on Kalman filtering | |
CN103218482A (en) | Estimation method for uncertain parameters in dynamic system | |
CN102032922A (en) | Inertial-navigation quick and initial alignment method under robust optimal significance | |
CN108121890A (en) | A kind of navigation attitude information fusion method based on linear Kalman filter | |
CN102880049B (en) | Adaptive vibrating control method based on sailboard flexible deformation measurement | |
CN103675880A (en) | Continuous navigation method implemented under satellite signal blocking condition |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20110427 |