CN106996778A - Error parameter scaling method and device - Google Patents
Error parameter scaling method and device Download PDFInfo
- Publication number
- CN106996778A CN106996778A CN201710170915.0A CN201710170915A CN106996778A CN 106996778 A CN106996778 A CN 106996778A CN 201710170915 A CN201710170915 A CN 201710170915A CN 106996778 A CN106996778 A CN 106996778A
- Authority
- CN
- China
- Prior art keywords
- matrix
- error
- vector
- singular value
- represent
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
The invention discloses a kind of error parameter scaling method and device.This method includes:Set up comprising error parameter vector in the state equation and measurement equation of aircraft guidance system, the state equation and measurement equation, the error parameter vector is made up of multiple error parameters;Differentiate the observability of each error parameter;When there is observable error parameter, using preset duration as filtering cycle, using Kalman filtering or adaptive-filtering, the observable error parameter is calibrated.The present invention realize in real time, on-orbit calibration go out Guidance instrumentation error parameter purpose.
Description
Technical field
The present invention relates to aircraft navigation control technology, more particularly to a kind of error parameter scaling method and device.
Background technology
Inertia type instrument is the heart of SINS, and the size of its error will directly affect the essence of entering the orbit of spacecraft
The size of degree and offset landings.Some spacecrafts for performing survey of deep space, after certain altitude is flown to, it is impossible to reuse group
Navigation is closed to be modified;Or important strike weapon, behind the native country that flies out, in order to improve its antijamming capability, Neng Gouzheng
Combinations of satellites navigation feature can also be closed by really performing strike task.Now, if it is possible to carry out an inertia system Guidance instrumentation
Error coefficient on-orbit calibration, will be an important means of raising spacecraft navigation accuracy, and error coefficient mask work
Core be method for parameter estimation research.
At present, the method comparative maturity of inertia system error parameter ground demarcation, but inertia system practical application
During into aerial mission, due to being shaken by aircraft, space environment is changed, and the error parameter of ground demarcation can not meet winged
Row device, spacecraft accurately determine the requirement of appearance positioning in space flight for a long time.
The content of the invention
Present invention solves the technical problem that being:Compared to prior art, there is provided a kind of error parameter scaling method and dress
Put, realize the purpose that real-time, on-orbit calibration goes out the error parameter of Guidance instrumentation.
The above-mentioned purpose of the present invention is achieved by the following technical programs:
In a first aspect, the invention provides a kind of error parameter scaling method, including:
Set up in the state equation and measurement equation of aircraft guidance system, the state equation and measurement equation and include
Error parameter vector, the error parameter vector is made up of multiple error parameters;
Differentiate the observability of each error parameter;
When there is observable error parameter, using preset duration as filtering cycle, Kalman filtering or adaptive is utilized
Filtering, calibrates the observable error parameter.
Further, the error parameter includes the misaligned angle of the platform error, velocity error, site error, the scale of gyro
Factor error, gyroscopic drift error, the drift error of the scale factor error of accelerometer and accelerometer;It is each described
Error parameter is vector, and includes three durection components.
Further, the state equation is:
In formula (1), A represents state matrix;The transition matrix of launching inertial system is tied to for aircraft body;X represents to miss
Poor parameter vector,φ represents the misaligned angle of the platform error, δ V
Velocity error is represented, δ r represent site error, δ KgRepresent the scale factor error of gyro, b1Represent gyroscopic drift error, δ KaTable
Show the scale factor error of accelerometer,The drift error of accelerometer is represented, T represents transposition computing;ηgRepresent that gyro is surveyed
The white noise of amount, εaFor the white noise of accelerometer measures;For error parameter vector X first derivative vector;The state
Matrix A is:
In formula (2), The aircraft body system measured for gyro is relative to transmitting inertia
The angular speed of system aircraft body system projection,Represent withFor the matrix of the elements in a main diagonal;fbThe specific force measured for accelerometer aircraft body system projection,Represent
SolveAntisymmetric matrix;I3×3The unit matrix of expression 3 × 3;G
Newtonian gravitational constant is represented, M represents earth quality, and x, y, z represents coordinate of the aircraft under launching inertial system, and r represents flight
Distance of the device to launching inertial system origin;The transition matrix of launching inertial system is tied to for aircraft body;
The measurement equation is:
In formula (3), Z (t) represents guidance matrix of differences;φi″The attitude angle and inertial reference calculation posture measured for star sensor
The difference at angle;Zv(t) it is the GPS aircraft speeds measured and the difference of the speed of inertial reference calculation;Zr(t) the aircraft position measured for GPS
Put the difference with the position of inertial reference calculation;H9×21Represent measurement matrix;X represents the error parameter vector;V9×1Represent white noise to
Amount;The measurement matrix H9×21For:
In formula (4), I3×3The unit matrix of expression 3 × 3;The white noise vector V9×1For:
In formula (5),WithWhite noise, δ M are measured for the posture of star sensorx、δMyWith δ MzFor GPS amount
Degree of testing the speed white noise, δ xG、δxGWith δ zGFor GPS adjustment location white noise;T represents transposition computing.
Further, the observability of each error parameter is differentiated, including:
Using the state matrix, transfer matrix is calculated, the calculation formula of the transfer matrix is:
In formula (6), Φk,k-1The expression state k-1 moment is to the transfer matrix at state k moment, I21×21The list of expression 21 × 21
Bit matrix;T1Represent preset duration;AkRepresent the state matrix of k-th of preset duration;M is positive integer and m >=2;
According to the transfer matrix and the measurement matrix, singular value decomposition matrix is treated in calculating, described to treat singular value decomposition
The calculation formula of matrix is:
In formula (7), Q represents to treat singular value decomposition matrix, H9×21Represent measurement matrix, Φ1,0The moment of expression state 0 is to shape
The transfer matrix at the moment of state 1, Φm-1,m-2The transfer matrix at expression state m-2 moment to state m-1 moment, T represents that transposition is transported
Calculate;
Treat that singular value decomposition matrix carries out singular value decomposition by described, to obtain the first singular value vector, the second singular value
Vector and singular value matrix, the formula of the singular value decomposition is:
Q=U ∑s VT (8)
In formula (8), Q represents to treat singular value decomposition matrix, and ∑ represents singular value matrix, and the elements in a main diagonal of ∑ is σi,i
∈[1,m];U represents the first singular value vector, U=[ui]=[u1u2...um];V represents the second singular value vector, V=[vi]=
[v1 v2 ... vm];T represents transposition computing;
Utilize the σi、ui、viAnd the guidance matrix of differences Z (t), calculate observability discriminant vector Y21×1, institute
The calculation formula for stating observability discriminant vector Y is:
In formula (9), T represents transposition computing;
By the observability discriminant vector Y21×1Each element be compared with given threshold δ e;
As the observability discriminant vector Y21×1L, the element at the column position of l ∈ [1,21] row the 1st is more than setting
During threshold value δ e, l in decision errors parameter vector X, the error parameter Observable at the column position of l ∈ [1,21] row the 1st.
Second aspect, present invention also offers a kind of error parameter caliberating device, the device includes:
Build module, state equation and measurement equation for setting up aircraft guidance system, the state equation and amount
Survey comprising error parameter vector in equation, the error parameter vector is made up of multiple error parameters;
Discrimination module, the observability for differentiating each error parameter;
Demarcating module, for when there is observable error parameter, using preset duration as filtering cycle, utilizing Kalman
Filtering or adaptive-filtering, calibrate the observable error parameter.
Further, the error parameter includes the misaligned angle of the platform error, velocity error, site error, the scale of gyro
Factor error, gyroscopic drift error, the drift error of the scale factor error of accelerometer and accelerometer;It is each described
Error parameter is vector, and includes three durection components.
Further, the state equation is:
In formula (1), A represents state matrix;Cb iThe transition matrix of launching inertial system is tied to for aircraft body;X represents to miss
Poor parameter vector,φ represents the misaligned angle of the platform error, δ V
Velocity error is represented, δ r represent site error, δ KgRepresent the scale factor error of gyro, b1Represent gyroscopic drift error, δ KaTable
Show the scale factor error of accelerometer,The drift error of accelerometer is represented, T represents transposition computing;ηgRepresent that gyro is surveyed
The white noise of amount, εaFor the white noise of accelerometer measures;For error parameter vector X first derivative vector;The state square
Battle array A be:
In formula (2), The aircraft body system measured for gyro is relative to launching inertial system
Angular speed aircraft body system projection,Represent withFor the matrix of the elements in a main diagonal;fbThe specific force measured for accelerometer aircraft body system projection,Represent
SolveAntisymmetric matrix;I3×3The unit matrix of expression 3 × 3;G
Newtonian gravitational constant is represented, M represents earth quality, x,y, z represents coordinate of the aircraft under launching inertial system, and r represents flight
Distance of the device to launching inertial system origin;The transition matrix of launching inertial system is tied to for aircraft body;
The measurement equation is:
In formula (3), Z (t) represents guidance matrix of differences;φi″The attitude angle and inertial reference calculation posture measured for star sensor
The difference at angle;Zv(t) it is the GPS aircraft speeds measured and the difference of the speed of inertial reference calculation;Zr(t) the aircraft position measured for GPS
Put the difference with the position of inertial reference calculation;H9×21Represent measurement matrix;X represents the error parameter vector;V9×1Represent white noise to
Amount;The measurement matrix H9×21For:
In formula (4), I3×3The unit matrix of expression 3 × 3;The white noise vector V9×1For:
In formula (5),WithWhite noise, δ M are measured for the posture of star sensorx、δMyWith δ MzFor GPS amount
Degree of testing the speed white noise, δ xG、δxGWith δ zGFor GPS adjustment location white noise;T represents transposition computing.
Further, the discrimination module includes:
First computing unit, for utilizing the state matrix, calculates transfer matrix, the calculation formula of the transfer matrix
For:
In formula (6), Φk,k-1The expression state k-1 moment is to the transfer matrix at state k moment, I21×21The list of expression 21 × 21
Bit matrix;T1Represent preset duration;AkRepresent the state matrix of k-th of preset duration;M is positive integer and m >=2;
Second computing unit, for according to the transfer matrix and the measurement matrix, calculating and treating singular value decomposition matrix,
It is described treat singular value decomposition matrix calculation formula be:
In formula (7), Q represents to treat singular value decomposition matrix, H9×21Represent measurement matrix, Φ1,0The moment of expression state 0 is to shape
The transfer matrix at the moment of state 1, Φm-1,m-2The transfer matrix at expression state m-2 moment to state m-1 moment, T represents that transposition is transported
Calculate;
Resolving cell, for by it is described treat singular value decomposition matrix carry out singular value decomposition, with obtain the first singular value to
Amount, the second singular value vector and singular value matrix, the formula of the singular value decomposition is:
Q=U ∑s VT (8)
In formula (8), Q represents to treat singular value decomposition matrix, and ∑ represents singular value matrix, and the elements in a main diagonal of ∑ is σi,i
∈[1,m];U represents the first singular value vector, U=[ui]=[u1 u2 ... um];V represents the second singular value vector, V=[vi]
=[v1 v2 ... vm];T represents transposition computing;
3rd computing unit, for utilizing the σi、ui、viAnd the guidance matrix of differences Z (t), calculate Observable
Property discriminant vector Y21×1, the calculation formula of the observability discriminant vector Y is:
In formula (9), T represents transposition computing;
Comparing unit, for by the observability discriminant vector Y21×1Each element compared with given threshold δ e
Compared with;
Identifying unit, for as the observability discriminant vector Y21×1L, at the column position of l ∈ [1,21] row the 1st
When element is more than given threshold δ e, l in decision errors parameter vector X, the error at the column position of l ∈ [1,21] row the 1st
Parameter Observable.
The present invention has the advantages that compared with prior art:
(1), the state equation and measurement equation of the invention by setting up aircraft guidance system;Differentiate each error parameter
Observability;When there is observable error parameter, using Kalman filtering or adaptive-filtering, calibrate described considerable
The error parameter of survey, can overcome the shortcomings of existing guidance instrument error isolation technics " world is inconsistent ", can be real-time, in-orbit
The error coefficient of Guidance instrumentation is calibrated, algorithm is simple, is easy to engineering.
(2), the present invention can reduce inertia device Support expense, due to the ability with on-orbit calibration, so as to
The number of times of inertia system ground periodic calibrating is enough reduced, is used manpower and material resources sparingly.
(3), the present invention can improve aircraft guidance precision, reduce the dependence to satellite navigation, extending space aircraft
The scope and ability of execution task.
Brief description of the drawings
Fig. 1 is a kind of flow chart of error parameter scaling method in the embodiment of the present invention one;
Fig. 2 is a kind of structure chart of error parameter caliberating device in the embodiment of the present invention two.
Embodiment
The present invention is described in further detail with reference to the accompanying drawings and examples.It is understood that described herein
Specific embodiment be used only for explaining the present invention, rather than limitation of the invention.It also should be noted that, for the ease of
Description, part related to the present invention rather than entire infrastructure are illustrate only in accompanying drawing.
Embodiment one
Fig. 1 is a kind of flow chart of error parameter scaling method in the embodiment of the present invention one, and the present embodiment is applicable to
The situation to the error parameter progress on-orbit calibration of Guidance instrumentation is needed, this method can be held by error parameter caliberating device
OK, wherein the device can be realized by software and/or hardware.With reference to Fig. 1, the error parameter scaling method tool that the present embodiment is provided
Body may include steps of:
In S110, the state equation and measurement equation for setting up aircraft guidance system, the state equation and measurement equation
Comprising error parameter vector, the error parameter vector is made up of multiple error parameters.
Specifically, the error parameter include the misaligned angle of the platform error, velocity error, site error, the scale of gyro because
Count the drift error of error, gyroscopic drift error, the scale factor error of accelerometer and accelerometer;Each mistake
Poor parameter is vector, and includes three durection components.Each error parameter is vector, and includes three directions
Component, i.e., each error parameter is vector, in respective coordinate system comprising three direction vectors.For example, gyroscopic drift error
Three durection components are included in its coordinate system:X-axis is to component, y-axis to component and z-axis to component.In another example, accelerometer
Scale factor error include three durection components in its coordinate system:X-axis is to component, y-axis to component and z-axis to component.
Specifically, the state equation is:
In formula (1), A represents state matrix;The transition matrix of launching inertial system is tied to for aircraft body;X represents to miss
Poor parameter vector,φ represents the misaligned angle of the platform error, δ
V represents velocity error, and δ r represent site error, δ KgRepresent the scale factor error of gyro, b1Represent gyroscopic drift error, δ Ka
The scale factor error of accelerometer is represented,The drift error of accelerometer is represented, T represents transposition computing;ηgRepresent gyro
The white noise of measurement, εaFor the white noise of accelerometer measures;For error parameter vector X first derivative vector;The shape
State matrix A is:
In formula (2), The aircraft body system measured for gyro is relative to launching inertial system
Angular speed aircraft body system projection,Represent withFor the matrix of the elements in a main diagonal;fbThe specific force measured for accelerometer aircraft body system projection,Represent
SolveAntisymmetric matrix;I3×3The unit matrix of expression 3 × 3;
G represents Newtonian gravitational constant, and M represents earth quality, x,y, z represents coordinate of the aircraft under launching inertial system, and r represents flight
Distance of the device to launching inertial system origin;The transition matrix of launching inertial system is tied to for aircraft body;
The measurement equation is:
In formula (3), Z (t) represents guidance matrix of differences;φi" it is attitude angle and inertial reference calculation posture that star sensor is measured
The difference at angle;Zv(t) it is the GPS aircraft speeds measured and the difference of the speed of inertial reference calculation;Zr(t) the aircraft position measured for GPS
Put the difference with the position of inertial reference calculation;H9×21Represent measurement matrix;X represents the error parameter vector;V9×1Represent white noise to
Amount;The measurement matrix H9×21For:
In formula (4), I3×3The unit matrix of expression 3 × 3;The white noise vector V9×1For:
In formula (5),WithWhite noise, δ M are measured for the posture of star sensorx、δMyWith δ MzFor GPS amount
Degree of testing the speed white noise, δ xG、δxGWith δ zGFor GPS adjustment location white noise;T represents transposition computing.
S120, the observability for differentiating each error parameter.
Optionally, the observability of each error parameter is differentiated, including:
Using the state matrix, transfer matrix is calculated, the calculation formula of the transfer matrix is:
In formula (6), Φk,k-1The expression state k-1 moment is to the transfer matrix at state k moment, I21×21The list of expression 21 × 21
Bit matrix;T1Represent preset duration;AkRepresent the state matrix of k-th of preset duration;M is positive integer and m >=2.
Specifically, T1Preset duration is represented, the preset duration is usually 200ms integral multiple, is 1s to the maximum.For example,
If preset duration T1=200ms, AkRepresent the state matrix of k-th of 200ms period.
According to the transfer matrix and the measurement matrix, singular value decomposition matrix is treated in calculating, described to treat singular value decomposition
The calculation formula of matrix is:
In formula (7), Q represents to treat singular value decomposition matrix, H9×21Represent measurement matrix, Φ1,0The moment of expression state 0 is to shape
The transfer matrix at the moment of state 1, Φm-1,m-2The transfer matrix at expression state m-2 moment to state m-1 moment, T represents that transposition is transported
Calculate.
Treat that singular value decomposition matrix carries out singular value decomposition by described, to obtain the first singular value vector, the second singular value
Vector and singular value matrix, the formula of the singular value decomposition is:
Q=U ∑s VT (8)
In formula (8), Q represents to treat singular value decomposition matrix, and ∑ represents singular value matrix, and the elements in a main diagonal of ∑ is σi,i
∈[1,m];U represents the first singular value vector, U=[ui]=[u1 u2 ... um];V represents the second singular value vector, V=[vi]
=[v1 v2 ... vm];T represents transposition computing.
Utilize the σi、ui、viAnd the guidance matrix of differences Z (t), calculate observability discriminant vector Y21×1, institute
The calculation formula for stating observability discriminant vector Y is:
In formula (9), T represents transposition computing.
By the observability discriminant vector Y21×1Each element be compared with given threshold δ e.
Specifically, due to observability discriminant vector Y21×1In each element scope between 0~1, thus, it is described
Given threshold δ e are chosen as 0.1.In the present embodiment, the given threshold δ e=0.1 will the observability discriminant vector
Y21×1Each element be compared with given threshold 0.1.
As the observability discriminant vector Y21×1L, the element at the column position of l ∈ [1,21] row the 1st is more than setting
During threshold value δ e, l in decision errors parameter vector X, the error parameter Observable at the column position of l ∈ [1,21] row the 1st.
Specifically, in the present embodiment,X represents to miss
Poor parameter vector, φ represents the misaligned angle of the platform error, and δ V represent velocity error, and δ r represent site error, δ KgRepresent the mark of gyro
Spend factor error, b1Represent gyroscopic drift error, δ KaThe scale factor error of accelerometer is represented,Represent accelerometer
Drift error;And each error parameter includes three direction vectors in respective coordinate system.For example, when the observability differentiates
Vectorial Y21×1The column position of the 10th row the 1st at element when being more than given threshold δ e=0.1, the in decision errors parameter vector X
The scale factor error δ K of the error parameter Observable at the column position of 10 row the 1st, i.e. gyrogObservable.In another example, work as institute
State observability discriminant vector Y21×1The column position of the 19th row the 1st at element be more than given threshold δ e=0.1 when, decision errors
The drift error of the error parameter Observable in parameter vector X at the column position of the 19th row the 1st, i.e. accelerometerIt is considerable
Survey.
S130, when there is observable error parameter, using preset duration as filtering cycle, using Kalman filtering or from
Adaptive filtering, calibrates the observable error parameter.
Specifically, in the present embodiment, when there is observable error parameter, with the preset duration in step S120
T1For filtering cycle, the filtering cycle can be taken as 200ms integral multiple, be 1s to the maximum.Utilize Kalman filtering or adaptive
Filtering, calibrates the observable error parameter.
The technical scheme of the present embodiment is by setting up the state equation and measurement equation of aircraft guidance system;Differentiate each
The observability of error parameter;When there is observable error parameter, using Kalman filtering or adaptive-filtering, calibrate
The observable error parameter, can overcome the shortcomings of existing guidance instrument error isolation technics " world is inconsistent ", can
In real time, on-orbit calibration goes out the error coefficient of Guidance instrumentation, and algorithm is simple, is easy to engineering;Inertia device can be reduced and safeguard guarantor
Barrier expense, due to the ability with on-orbit calibration, so as to reduce the number of times of inertia system ground periodic calibrating, saves manpower
Material resources;Aircraft guidance precision can be improved, the dependence to satellite navigation is reduced, extending space aircraft performs the scope of task
And ability.
Embodiment two
Fig. 2 is a kind of structure chart of error parameter caliberating device in the embodiment of the present invention two, and the present embodiment is applicable to
Need the situation to the error parameter progress on-orbit calibration of Guidance instrumentation.With reference to Fig. 2, the error parameter demarcation that the present embodiment is provided
Device specifically can be as follows:
Build module 210, state equation and measurement equation for setting up aircraft guidance system, the state equation and
Comprising error parameter vector in measurement equation, the error parameter vector is made up of multiple error parameters;
Discrimination module 220, the observability for differentiating each error parameter;
Demarcating module 230, for when there is observable error parameter, using preset duration as filtering cycle, utilizing card
Kalman Filtering or adaptive-filtering, calibrate the observable error parameter.
Optionally, the error parameter include the misaligned angle of the platform error, velocity error, site error, the scale of gyro because
Count the drift error of error, gyroscopic drift error, the scale factor error of accelerometer and accelerometer;Each mistake
Poor parameter is vector, and includes three durection components.
Optionally, the state equation is:
In formula (1), A represents state matrix;The transition matrix of launching inertial system is tied to for aircraft body;X represents to miss
Poor parameter vector,φ represents the misaligned angle of the platform error, δ V
Velocity error is represented, δ r represent site error, δ KgRepresent the scale factor error of gyro, b1Represent gyroscopic drift error, δ KaTable
Show the scale factor error of accelerometer,The drift error of accelerometer is represented, T represents transposition computing;ηgRepresent that gyro is surveyed
The white noise of amount, εaFor the white noise of accelerometer measures;For error parameter vector X first derivative vector;The state square
Battle array A be:
In formula (2), The aircraft body system measured for gyro is relative to launching inertial system
Angular speed aircraft body system projection,Represent withFor the matrix of the elements in a main diagonal;fbThe specific force measured for accelerometer aircraft body system projection,Represent
SolveAntisymmetric matrix;I3×3The unit matrix of expression 3 × 3;
G represents Newtonian gravitational constant, and M represents earth quality, and x, y, z represents coordinate of the aircraft under launching inertial system, and r represents flight
Distance of the device to launching inertial system origin;The transition matrix of launching inertial system is tied to for aircraft body;
The measurement equation is:
In formula (3), Z (t) represents guidance matrix of differences;φi" it is attitude angle and inertial reference calculation posture that star sensor is measured
The difference at angle;Zv(t) it is the GPS aircraft speeds measured and the difference of the speed of inertial reference calculation;Zr(t) the aircraft position measured for GPS
Put the difference with the position of inertial reference calculation;H9×21Represent measurement matrix;X represents the error parameter vector;V9×1Represent white noise to
Amount;The measurement matrix H9×21For:
In formula (4), I3×3The unit matrix of expression 3 × 3;The white noise vector V9×1For:
In formula (5),WithWhite noise, δ M are measured for the posture of star sensorx、δMyWith δ MzFor GPS amount
Degree of testing the speed white noise, δ xG、δxGWith δ zGFor GPS adjustment location white noise;T represents transposition computing.
Optionally, the discrimination module includes:
First computing unit, for utilizing the state matrix, calculates transfer matrix, the calculation formula of the transfer matrix
For:
In formula (6), Φk,k-1The expression state k-1 moment is to the transfer matrix at state k moment, I21×21The list of expression 21 × 21
Bit matrix;T1Represent preset duration;AkRepresent the state matrix of k-th of preset duration;M is positive integer and m >=2;
Second computing unit, for according to the transfer matrix and the measurement matrix, calculating and treating singular value decomposition matrix,
It is described treat singular value decomposition matrix calculation formula be:
In formula (7), Q represents to treat singular value decomposition matrix, H9×21Represent measurement matrix, Φ1,0The moment of expression state 0 is to shape
The transfer matrix at the moment of state 1, Φm-1,m-2The transfer matrix at expression state m-2 moment to state m-1 moment, T represents that transposition is transported
Calculate;
Resolving cell, for by it is described treat singular value decomposition matrix carry out singular value decomposition, with obtain the first singular value to
Amount, the second singular value vector and singular value matrix, the formula of the singular value decomposition is:
Q=U ∑s VT (8)
In formula (8), Q represents to treat singular value decomposition matrix, and ∑ represents singular value matrix, and the elements in a main diagonal of ∑ is σi,i
∈[1,m];U represents the first singular value vector, U=[ui]=[u1 u2 ... um];V represents the second singular value vector, V=[vi]
=[v1 v2 ... vm];T represents transposition computing;
3rd computing unit, for utilizing the σi、ui、viAnd the guidance matrix of differences Z (t), calculate Observable
Property discriminant vector Y21×1, the calculation formula of the observability discriminant vector Y is:
In formula (9), T represents transposition computing;
Comparing unit, for by the observability discriminant vector Y21×1Each element compared with given threshold δ e
Compared with;
Identifying unit, for as the observability discriminant vector Y21×1L, at the column position of l ∈ [1,21] row the 1st
When element is more than given threshold δ e, l in decision errors parameter vector X, the error at the column position of l ∈ [1,21] row the 1st
Parameter Observable.
The error parameter caliberating device that the present embodiment is provided, is demarcated with the error parameter that any embodiment of the present invention is provided
Method belongs to same inventive concept, can perform the error parameter scaling method that any embodiment of the present invention is provided, possesses execution
The corresponding functional module of error parameter scaling method and beneficial effect.Not ins and outs of detailed description in the present embodiment, can
The error parameter scaling method provided referring to any embodiment of the present invention.
Note, above are only presently preferred embodiments of the present invention and institute's application technology principle.It will be appreciated by those skilled in the art that
The invention is not restricted to specific embodiment described here, can carry out for a person skilled in the art it is various it is obvious change,
Readjust and substitute without departing from protection scope of the present invention.Therefore, although the present invention is carried out by above example
It is described in further detail, but the present invention is not limited only to above example, without departing from the inventive concept, also
Other more equivalent embodiments can be included, and the scope of the present invention is determined by scope of the appended claims.
Claims (8)
1. a kind of error parameter scaling method, it is characterised in that including:
Set up and error is included in the state equation and measurement equation of aircraft guidance system, the state equation and measurement equation
Parameter vector, the error parameter vector is made up of multiple error parameters;
Differentiate the observability of each error parameter;
When there is observable error parameter, using preset duration as filtering cycle, using Kalman filtering or adaptive-filtering,
Calibrate the observable error parameter.
2. according to the method described in claim 1, it is characterised in that the error parameter includes the misaligned angle of the platform error, speed
Error, site error, the scale factor error of gyro, gyroscopic drift error, the scale factor error of accelerometer and acceleration
Spend the drift error of meter;Each error parameter is vector, and includes three durection components.
3. according to the method described in claim 1, it is characterised in that the state equation is:
In formula (1), A represents state matrix;The transition matrix of launching inertial system is tied to for aircraft body;X represents that error is joined
Number vector,φ represents the misaligned angle of the platform error, and δ V are represented
Velocity error, δ r represent site error, δ KgRepresent the scale factor error of gyro, b1Represent gyroscopic drift error, δ KaRepresent to add
The scale factor error of speedometer,The drift error of accelerometer is represented, T represents transposition computing;ηgRepresent gyro to measure
White noise, εaFor the white noise of accelerometer measures;For error parameter vector X first derivative vector;The state matrix A
For:
In formula (2), Angular speed of the aircraft body system relative to launching inertial system measured for gyro
In the projection of aircraft body system,Represent withFor the matrix of the elements in a main diagonal;
fbThe specific force measured for accelerometer aircraft body system projection,Represent to solveAntisymmetric matrix;
I3×3The unit matrix of expression 3 × 3;G represents Newtonian gravitational constant, M
Earth quality is represented, x, y, z represents coordinate of the aircraft under launching inertial system, and r represents aircraft to launching inertial system origin
Distance;The transition matrix of launching inertial system is tied to for aircraft body;
The measurement equation is:
In formula (3), Z (t) represents guidance matrix of differences;φi”For star sensor measure attitude angle and inertial reference calculation attitude angle it
Difference;Zv(t) it is the GPS aircraft speeds measured and the difference of the speed of inertial reference calculation;Zr(t) for GPS measure position of aircraft and
The difference of the position of inertial reference calculation;H9×21Represent measurement matrix;X represents the error parameter vector;V9×1Represent white noise vector;
The measurement matrix H9×21For:
In formula (4), I3×3The unit matrix of expression 3 × 3;The white noise vector V9×1For:
In formula (5),WithWhite noise, δ M are measured for the posture of star sensorx、δMyWith δ MzFor GPS measurement speed
Spend white noise, δ xG、δxGWith δ zGFor GPS adjustment location white noise;T represents transposition computing.
4. method according to claim 3, it is characterised in that differentiate the observability of each error parameter, including:
Using the state matrix, transfer matrix is calculated, the calculation formula of the transfer matrix is:
In formula (6), Φk,k-1The expression state k-1 moment is to the transfer matrix at state k moment, I21×21The unit square of expression 21 × 21
Battle array;T1Represent preset duration;AkRepresent the state matrix of k-th of preset duration;M is positive integer and m >=2;
According to the transfer matrix and the measurement matrix, singular value decomposition matrix is treated in calculating, described to treat singular value decomposition matrix
Calculation formula be:
In formula (7), Q represents to treat singular value decomposition matrix, H9×21Represent measurement matrix, Φ1,0When the moment of expression state 0 is to state 1
The transfer matrix at quarter, Φm-1,m-2The transfer matrix at expression state m-2 moment to state m-1 moment, T represents transposition computing;
By it is described treat singular value decomposition matrix carry out singular value decomposition, with obtain the first singular value vector, the second singular value vector,
And singular value matrix, the formula of the singular value decomposition is:
Q=U ∑s VT (8)
In formula (8), Q represents to treat singular value decomposition matrix, and ∑ represents singular value matrix, and the elements in a main diagonal of ∑ is σi,i∈[1,
m];U represents the first singular value vector, U=[ui]=[u1 u2 ... um];V represents the second singular value vector, V=[vi]=[v1
v2 ... vm];T represents transposition computing;
Utilize the σi、ui、viAnd the guidance matrix of differences Z (t), calculate observability discriminant vector Y21×1, it is described can
Observation discriminant vector Y calculation formula is:
In formula (9), T represents transposition computing;
By the observability discriminant vector Y21×1Each element be compared with given threshold δ e;
As the observability discriminant vector Y21×1L, the element at the column position of l ∈ [1,21] row the 1st is more than given threshold δ
During e, l in decision errors parameter vector X, the error parameter Observable at the column position of l ∈ [1,21] row the 1st.
5. a kind of error parameter caliberating device, it is characterised in that including:
Build module, state equation and measurement equation for setting up aircraft guidance system, the state equation and measurement side
Cheng Zhongjun includes error parameter vector, and the error parameter vector is made up of multiple error parameters;
Discrimination module, the observability for differentiating each error parameter;
Demarcating module, for when there is observable error parameter, using preset duration as filtering cycle, utilizing Kalman filtering
Or adaptive-filtering, calibrate the observable error parameter.
6. device according to claim 5, it is characterised in that the error parameter includes the misaligned angle of the platform error, speed
Error, site error, the scale factor error of gyro, gyroscopic drift error, the scale factor error of accelerometer and acceleration
Spend the drift error of meter;Each error parameter is vector, and includes three durection components.
7. device according to claim 5, it is characterised in that the state equation is:
In formula (1), A represents state matrix;The transition matrix of launching inertial system is tied to for aircraft body;X represents that error is joined
Number vector,φ represents the misaligned angle of the platform error, and δ V are represented
Velocity error, δ r represent site error, δ KgRepresent the scale factor error of gyro, b1Represent gyroscopic drift error, δ KaRepresent to add
The scale factor error of speedometer,The drift error of accelerometer is represented, T represents transposition computing;ηgRepresent gyro to measure
White noise, εaFor the white noise of accelerometer measures;For error parameter vector X first derivative vector;The state matrix A
For:
In formula (2), Angular speed of the aircraft body system relative to launching inertial system measured for gyro
In the projection of aircraft body system,Represent withFor the matrix of the elements in a main diagonal;
fbThe specific force measured for accelerometer aircraft body system projection,Represent to solveAntisymmetric matrix;
I3×3The unit matrix of expression 3 × 3;G represents Newtonian gravitational constant, M
Earth quality is represented, x, y, z represents coordinate of the aircraft under launching inertial system, and r represents aircraft to launching inertial system origin
Distance;The transition matrix of launching inertial system is tied to for aircraft body;
The measurement equation is:
In formula (3), Z (t) represents guidance matrix of differences;φi”For star sensor measure attitude angle and inertial reference calculation attitude angle it
Difference;Zv(t) it is the GPS aircraft speeds measured and the difference of the speed of inertial reference calculation;Zr(t) for GPS measure position of aircraft and
The difference of the position of inertial reference calculation;H9×21Represent measurement matrix;X represents the error parameter vector;V9×1Represent white noise vector;
The measurement matrix H9×21For:
In formula (4), I3×3The unit matrix of expression 3 × 3;The white noise vector V9×1For:
In formula (5),WithWhite noise, δ M are measured for the posture of star sensorx、δMyWith δ MzFor GPS measurement speed
Spend white noise, δ xG、δxGWith δ zGFor GPS adjustment location white noise;T represents transposition computing.
8. device according to claim 7, it is characterised in that the discrimination module includes:
First computing unit, for utilizing the state matrix, calculates transfer matrix, the calculation formula of the transfer matrix is:
In formula (6), Φk,k-1The expression state k-1 moment is to the transfer matrix at state k moment, I21×21The unit square of expression 21 × 21
Battle array;T1Represent preset duration;AkRepresent the state matrix of k-th of preset duration;M is positive integer and m >=2;
Second computing unit, for according to the transfer matrix and the measurement matrix, singular value decomposition matrix to be treated in calculating, described
The calculation formula for treating singular value decomposition matrix is:
In formula (7), Q represents to treat singular value decomposition matrix, H9×21Represent measurement matrix, Φ1,0When the moment of expression state 0 is to state 1
The transfer matrix at quarter, Φm-1,m-2The transfer matrix at expression state m-2 moment to state m-1 moment, T represents transposition computing;
Resolving cell, for treating that singular value decomposition matrix carries out singular value decomposition by described, to obtain the first singular value vector, the
Two singular value vectors and singular value matrix, the formula of the singular value decomposition is:
Q=U ∑s VT (8)
In formula (8), Q represents to treat singular value decomposition matrix, and ∑ represents singular value matrix, and the elements in a main diagonal of ∑ is σi,i∈[1,
m];U represents the first singular value vector, U=[ui]=[u1 u2 ... um];V represents the second singular value vector, V=[vi]=[v1
v2 ... vm];T represents transposition computing;
3rd computing unit, for utilizing the σi、ui、viAnd the guidance matrix of differences Z (t), calculate observability and sentence
Not vector Y21×1, the calculation formula of the observability discriminant vector Y is:
In formula (9), T represents transposition computing;
Comparing unit, for by the observability discriminant vector Y21×1Each element be compared with given threshold δ e;
Identifying unit, for as the observability discriminant vector Y21×1L, the element at the column position of l ∈ [1,21] row the 1st
During more than given threshold δ e, l in decision errors parameter vector X, the error parameter at the column position of l ∈ [1,21] row the 1st
Observable.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710170915.0A CN106996778B (en) | 2017-03-21 | 2017-03-21 | Error parameter scaling method and device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710170915.0A CN106996778B (en) | 2017-03-21 | 2017-03-21 | Error parameter scaling method and device |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106996778A true CN106996778A (en) | 2017-08-01 |
CN106996778B CN106996778B (en) | 2019-11-29 |
Family
ID=59431707
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710170915.0A Active CN106996778B (en) | 2017-03-21 | 2017-03-21 | Error parameter scaling method and device |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106996778B (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110608741A (en) * | 2019-09-25 | 2019-12-24 | 北京安达维尔科技股份有限公司 | Method for improving attitude calculation precision of aircraft attitude and heading reference system |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1995916A (en) * | 2006-12-27 | 2007-07-11 | 北京航空航天大学 | Integrated navigation method based on star sensor calibration |
US20070222674A1 (en) * | 2006-03-24 | 2007-09-27 | Containertrac, Inc. | Automated asset positioning for location and inventory tracking using multiple positioning techniques |
CN102297695A (en) * | 2010-06-22 | 2011-12-28 | 中国船舶重工集团公司第七○七研究所 | Kalman filtering method in deep integrated navigation system |
CN102879011A (en) * | 2012-09-21 | 2013-01-16 | 北京控制工程研究所 | Lunar inertial navigation alignment method assisted by star sensor |
CN103245359A (en) * | 2013-04-23 | 2013-08-14 | 南京航空航天大学 | Method for calibrating fixed errors of inertial sensor in inertial navigation system in real time |
CN103557871A (en) * | 2013-10-22 | 2014-02-05 | 北京航空航天大学 | Strap-down inertial navigation air initial alignment method for floating aircraft |
US20140336970A1 (en) * | 2013-05-13 | 2014-11-13 | Giancarlo Troni-Peralta | System and method for determining and correcting field sensors errors |
CN104764467A (en) * | 2015-04-08 | 2015-07-08 | 南京航空航天大学 | Online adaptive calibration method for inertial sensor errors of aerospace vehicle |
CN105352529A (en) * | 2015-11-16 | 2016-02-24 | 南京航空航天大学 | Multisource-integrated-navigation-system distributed inertia node total-error on-line calibration method |
CN105867399A (en) * | 2016-04-18 | 2016-08-17 | 北京航天自动控制研究所 | Method for determining multi-state tracking guidance parameters |
CN106052716A (en) * | 2016-05-25 | 2016-10-26 | 南京航空航天大学 | Method for calibrating gyro errors online based on star light information assistance in inertial system |
-
2017
- 2017-03-21 CN CN201710170915.0A patent/CN106996778B/en active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20070222674A1 (en) * | 2006-03-24 | 2007-09-27 | Containertrac, Inc. | Automated asset positioning for location and inventory tracking using multiple positioning techniques |
CN1995916A (en) * | 2006-12-27 | 2007-07-11 | 北京航空航天大学 | Integrated navigation method based on star sensor calibration |
CN102297695A (en) * | 2010-06-22 | 2011-12-28 | 中国船舶重工集团公司第七○七研究所 | Kalman filtering method in deep integrated navigation system |
CN102879011A (en) * | 2012-09-21 | 2013-01-16 | 北京控制工程研究所 | Lunar inertial navigation alignment method assisted by star sensor |
CN103245359A (en) * | 2013-04-23 | 2013-08-14 | 南京航空航天大学 | Method for calibrating fixed errors of inertial sensor in inertial navigation system in real time |
US20140336970A1 (en) * | 2013-05-13 | 2014-11-13 | Giancarlo Troni-Peralta | System and method for determining and correcting field sensors errors |
CN103557871A (en) * | 2013-10-22 | 2014-02-05 | 北京航空航天大学 | Strap-down inertial navigation air initial alignment method for floating aircraft |
CN104764467A (en) * | 2015-04-08 | 2015-07-08 | 南京航空航天大学 | Online adaptive calibration method for inertial sensor errors of aerospace vehicle |
CN105352529A (en) * | 2015-11-16 | 2016-02-24 | 南京航空航天大学 | Multisource-integrated-navigation-system distributed inertia node total-error on-line calibration method |
CN105867399A (en) * | 2016-04-18 | 2016-08-17 | 北京航天自动控制研究所 | Method for determining multi-state tracking guidance parameters |
CN106052716A (en) * | 2016-05-25 | 2016-10-26 | 南京航空航天大学 | Method for calibrating gyro errors online based on star light information assistance in inertial system |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110608741A (en) * | 2019-09-25 | 2019-12-24 | 北京安达维尔科技股份有限公司 | Method for improving attitude calculation precision of aircraft attitude and heading reference system |
Also Published As
Publication number | Publication date |
---|---|
CN106996778B (en) | 2019-11-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106989761B (en) | A kind of spacecraft Guidance instrumentation on-orbit calibration method based on adaptive-filtering | |
CN100585602C (en) | Inertial measuring system error model demonstration test method | |
Zheng et al. | An eight-position self-calibration method for a dual-axis rotational inertial navigation system | |
Li et al. | Error analysis and gyro-bias calibration of analytic coarse alignment for airborne POS | |
CN103900576B (en) | A kind of information fusion method of survey of deep space independent navigation | |
CN102879011B (en) | Lunar inertial navigation alignment method assisted by star sensor | |
CN106289246A (en) | A kind of rods arm measure method based on position and orientation measurement system | |
Lu et al. | An all-parameter system-level calibration for stellar-inertial navigation system on ground | |
CN103913181A (en) | Airborne distribution type POS (position and orientation system) transfer alignment method based on parameter identification | |
CN110887507B (en) | Method for quickly estimating all zero offsets of inertial measurement units | |
CN102519485B (en) | Gyro information-introduced double-position strapdown inertial navigation system initial alignment method | |
CN104236586B (en) | Moving base transfer alignment method based on measurement of misalignment angle | |
Yao et al. | Transverse Navigation under the Ellipsoidal Earth Model and its Performance in both Polar and Non-polar areas | |
CN110296719B (en) | On-orbit calibration method | |
Gebre-Egziabher et al. | MAV attitude determination by vector matching | |
CN107144283A (en) | A kind of high considerable degree optical pulsar hybrid navigation method for deep space probe | |
CN104833375B (en) | A kind of IMU Two position methods by star sensor | |
CN107101649A (en) | A kind of in-orbit error separating method of spacecraft Guidance instrumentation | |
Li et al. | Fast fine initial self-alignment of INS in erecting process on stationary base | |
Cilden et al. | Attitude and attitude rate estimation for a nanosatellite using SVD and UKF | |
CN109708663A (en) | Star sensor online calibration method based on sky and space plane SINS auxiliary | |
CN106996778B (en) | Error parameter scaling method and device | |
CN103913169A (en) | Strap-down inertial/starlight refraction combined navigation method of aircrafts | |
Tie et al. | The impact of initial alignment on compensation for deflection of vertical in inertial navigation | |
McAnanama et al. | An open source flight dynamics model and IMU signal simulator |
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 |