CN113447019A - INS/CNS integrated navigation method, system, storage medium and equipment - Google Patents
INS/CNS integrated navigation method, system, storage medium and equipment Download PDFInfo
- Publication number
- CN113447019A CN113447019A CN202110898503.5A CN202110898503A CN113447019A CN 113447019 A CN113447019 A CN 113447019A CN 202110898503 A CN202110898503 A CN 202110898503A CN 113447019 A CN113447019 A CN 113447019A
- Authority
- CN
- China
- Prior art keywords
- ins
- error
- cns
- attitude
- navigation system
- 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
- 238000000034 method Methods 0.000 title claims abstract description 73
- 238000005259 measurement Methods 0.000 claims abstract description 41
- 238000013528 artificial neural network Methods 0.000 claims abstract description 37
- 238000001914 filtration Methods 0.000 claims description 40
- 230000008569 process Effects 0.000 claims description 40
- 238000012549 training Methods 0.000 claims description 40
- 239000011159 matrix material Substances 0.000 claims description 17
- 238000004422 calculation algorithm Methods 0.000 claims description 16
- 238000004590 computer program Methods 0.000 claims description 7
- 230000006870 function Effects 0.000 description 9
- 238000005457 optimization Methods 0.000 description 8
- 238000000354 decomposition reaction Methods 0.000 description 5
- 238000012937 correction Methods 0.000 description 4
- 238000012545 processing Methods 0.000 description 4
- 230000001133 acceleration Effects 0.000 description 3
- 230000008901 benefit Effects 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000015556 catabolic process Effects 0.000 description 1
- 238000006731 degradation reaction Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 239000002994 raw material Substances 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000007619 statistical method Methods 0.000 description 1
- 230000009897 systematic effect Effects 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
Images
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
- G01C21/165—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 combined with non-inertial navigation instruments
-
- 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/20—Instruments for performing navigational calculations
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 relates to an INS/CNS integrated navigation method, a system, a storage medium and equipment, wherein the INS/CNS integrated navigation method comprises the following steps: acquiring attitude, speed and position information of a target, and acquiring a non-Gaussian measurement noise variance and a predicted value of an optimal estimation error in the attitude, speed and position information based on a trained neural network; correcting the optimal estimation error value in the INS/CNS integrated navigation system based on the non-Gaussian measured noise variance and the predicted value of the optimal estimation error; and correcting the output target attitude, speed and position information based on the corrected optimal estimated error value, thereby obtaining the navigation information output by the INS/CNS integrated navigation system. The problem of low navigation precision of the INS/CNS integrated navigation system in the non-Gaussian measurement noise environment is solved, and the method is suitable for the non-Gaussian measurement noise environment.
Description
Technical Field
The invention relates to the field of integrated navigation control, in particular to an INS/CNS integrated navigation method, system, storage medium and equipment.
Background
The statements in this section merely provide background information related to the present disclosure and may not necessarily constitute prior art.
The INS/CNS integrated navigation system can realize high-precision navigation positioning, and the traditional Kalman filtering algorithm involved in the data processing process in the navigation process realizes the optimal estimation of state quantity through the minimum mean square error estimation under the condition that the integrated navigation system model is supposed to meet Gaussian distribution. However, due to the complex motion environment of the carrier/target where the INS/CNS integrated navigation system is located, the INS (inertial navigation system) and CNS (astronomical navigation system) measurements of the INS/CNS integrated navigation system are usually affected by non-gaussian noise, and if a filtering algorithm based on gaussian assumption is still used in this situation, performance of the filter may be degraded, and even a phenomenon of filter divergence may occur, so that the navigation accuracy of the INS/CNS integrated navigation system may be seriously degraded.
Disclosure of Invention
In order to solve at least one technical problem in the background art, the present invention provides an INS/CNS integrated navigation method, system, storage medium and device, which overcome the problems of reduced navigation accuracy of the INS/CNS integrated navigation system and low execution efficiency of the conventional INS/CNS integrated navigation method in the non-gaussian measurement noise environment.
In order to achieve the purpose, the invention adopts the following technical scheme:
a first aspect of the invention provides a method of INS/CNS integrated navigation comprising the steps of:
acquiring attitude, speed and position information of a target, and acquiring a non-Gaussian measurement noise variance and a predicted value of an optimal estimation error in the attitude, speed and position information based on a trained neural network;
correcting the optimal estimation error value in the INS/CNS integrated navigation system based on the non-Gaussian measured noise variance and the predicted value of the optimal estimation error;
and correcting the output target attitude, speed and position information based on the corrected optimal estimated error value, thereby obtaining the navigation information output by the INS/CNS integrated navigation system.
The INS/CNS integrated navigation system has a first subsystem and a second subsystem.
The training process of the neural network comprises the steps that a first subsystem takes a platform misalignment angle, a speed error, a position error, a gyro constant drift and an accelerometer constant bias as state quantities, and takes the difference between attitude, position and apparent height data output by an astronomical navigation system and attitude, position and apparent height data output by an inertial navigation system as observed quantities to construct an INS/CNS integrated navigation system model; based on an INS/CNS integrated navigation system model, the Kalman filtering algorithm of the maximum correlation entropy is utilized to obtain the optimal filtering estimation values of attitude error, speed error and position error in the output data of the inertial navigation system.
The training process of the neural network further comprises the steps of training the neural network of the first subsystem by respectively using the filter gain sequence obtained at the first n moments in the filtering process and the measurement noise variance matrix obtained in the filtering process at the current moment as input and output samples, and outputting an optimal learning training result, wherein n is more than or equal to 1.
The training process of the neural network further comprises the steps that the second subsystem takes a platform misalignment angle, a speed error, a position error, gyro constant drift and accelerometer constant bias as state quantities, the difference between attitude, position and apparent height data output by the astronomical navigation system and attitude, position and apparent height data output by the inertial navigation system is taken as system view measurement, the optimal training result of the neural network of the first subsystem is input into a volume Kalman filter of the second subsystem, optimal filtering estimation is carried out on the error of the inertial navigation system, and the optimal values of the attitude error, the speed error and the position error are obtained.
The training process of the neural network further comprises the steps of obtaining the difference value of the attitude error, the speed error and the position error of the first subsystem and the second subsystem, respectively serving as the input sample and the output sample of the neural network of the second subsystem for training based on the difference value and the filtering gain of the second subsystem at the current moment, and outputting the optimal learning training result.
Under the condition that the measurement noise is non-Gaussian noise, the filter gain sequence of the first n moments in the second subsystem is input into the trained neural network of the first subsystem, and a variance matrix of the measurement noise at the current moment is predicted, wherein n is more than or equal to 1; the second subsystem obtains a filtering estimation value of a system error based on a variance matrix of the measured noise at the current moment, obtains a filtering gain at the current moment, takes the filtering gain as the input of a neural network of the second subsystem, and predicts an error value of optimal estimation at the current moment; and correcting the system error of the inertial navigation system based on the predicted error value to obtain a corrected attitude error, a corrected speed error and a corrected position error.
A second aspect of the invention provides an INS/CNS combination navigation system comprising:
a prediction module configured to: acquiring attitude, speed and position information of a target, and acquiring a non-Gaussian measurement noise variance and a predicted value of an optimal estimation error in the attitude, speed and position information based on a trained neural network;
a compensation module configured to: correcting the optimal estimation error value in the INS/CNS integrated navigation system based on the non-Gaussian measured noise variance and the predicted value of the optimal estimation error;
an output module configured to: and correcting the output target attitude, speed and position information based on the corrected optimal estimated error value, thereby obtaining the navigation information output by the INS/CNS integrated navigation system.
A third aspect of the invention provides a computer-readable storage medium.
A computer readable storage medium having stored thereon a computer program which, when executed by a processor, carries out the steps of the INS/CNS combination navigation method as described above.
A fourth aspect of the invention provides a computer apparatus.
A computer apparatus comprising a memory, a processor and a computer program stored on the memory and executable on the processor, the processor when executing the program implementing the steps in the combined INS/CNS navigation method as described above.
Compared with the prior art, the above one or more technical schemes have the following beneficial effects:
1. the problem of low navigation precision of the INS/CNS integrated navigation system in the non-Gaussian measurement noise environment is solved, and the method is suitable for the non-Gaussian measurement noise environment.
2. Compared with an INS/CNS integrated navigation algorithm based on an information theory optimization criterion, the execution efficiency of the navigation process is obviously improved.
3. On the premise of not increasing the hardware cost and the like, the precision and the real-time performance of the INS/CNS integrated navigation system are improved.
Drawings
The accompanying drawings, which are incorporated in and constitute a part of this specification, are included to provide a further understanding of the invention, and are incorporated in and constitute a part of this specification, illustrate exemplary embodiments of the invention and together with the description serve to explain the invention and not to limit the invention.
FIG. 1 is a schematic diagram of an INS/CNS integrated navigation system provided by one or more embodiments of the present invention in an initial training phase;
fig. 2 is a schematic diagram of an INS/CNS integrated navigation system during a real-time estimation and error compensation phase of measured noise variance according to one or more embodiments of the present invention.
Detailed Description
The invention is further described with reference to the following figures and examples.
It is to be understood that the following detailed description is exemplary and is intended to provide further explanation of the invention as claimed. Unless defined otherwise, all technical and scientific terms used herein have the same meaning as commonly understood by one of ordinary skill in the art to which this invention belongs.
It is noted that the terminology used herein is for the purpose of describing particular embodiments only and is not intended to be limiting of exemplary embodiments according to the invention. As used herein, the singular forms "a", "an" and "the" are intended to include the plural forms as well, and it should be understood that when the terms "comprises" and/or "comprising" are used in this specification, they specify the presence of stated features, steps, operations, devices, components, and/or combinations thereof, unless the context clearly indicates otherwise.
The INS/CNS integrated navigation system is a navigation system formed by a star sensor on the basis of a traditional pure inertial navigation system. The INS is an autonomous navigation system which uses an accelerometer to measure the motion acceleration of a carrier under a reference coordinate system (inertial coordinate system) established by a gyroscope to calculate the position, speed and attitude of the carrier in real time. Usually consisting of an inertial measurement unit and a processing unit. The inertial measurement unit comprises an accelerometer and a gyroscope, the gyroscope is used for measuring the rotation motion of the carrier, and the accelerometer is used for measuring the translation motion acceleration of the carrier; and the processing unit calculates the speed, position and attitude data of the carrier according to the measured acceleration signal and angular motion signal, and finishes the output of the carrier navigation information. The navigation task is completed independently by completely depending on the inertial device, and the navigation task is not linked with the outside, so that the navigation device has the advantages of high short-time precision, continuous output, strong anti-interference capability, capability of providing position and attitude information and the like; however, the navigation error is accumulated with time, and the error of long-time work is large. The CNS is a navigation system for calculating the position of a carrier by using the direction information of a celestial body measured by a celestial body sensor. The celestial body is used as a navigation information source, has good concealment and strong autonomy, can provide position information and high-precision attitude information, but has discontinuous output information and is easily influenced by the environment. Because inertia and astronomical navigation systems have advantages and disadvantages, the inertia and astronomical navigation systems are combined to form an INS/CNS integrated navigation system, errors such as attitude errors and gyro constant drift are corrected by using starlight information, advantage complementation is realized, the precision and reliability of the navigation system are improved, and the inertial navigation system and the astronomical navigation system become an important development direction of guided missile and airplane navigation technologies.
As described in the background art, due to the complex motion environment of the carrier/target on which the INS/CNS integrated navigation system is located, the INS (inertial navigation system) and CNS (astronomical navigation system) measurements of the INS/CNS integrated navigation system are usually affected by non-gaussian noise, and if a filtering algorithm based on the gaussian assumption is still used in such a situation, performance degradation of the filter and even a phenomenon of filter divergence occur, which leads to a serious reduction in the navigation accuracy of the INS/CNS integrated navigation system.
The optimization criterion in the information theory uses information argument (such as entropy) estimated from data to replace the commonly used second-order statistics such as variance and covariance as the optimization index. Especially the maximum correlation entropy criterion in the information theory, it can realize the statistical analysis of the second order and above error terms. Therefore, kalman filtering algorithms based on maximum correlation entropy are proposed and used in large quantities (e.g. the MCGHCKF algorithm). However, some of the parameters in such algorithms are set based on human experience, and the metrology update process is inefficient due to the presence of iterative optimization.
Therefore, in order to better adapt the INS/CNS integrated navigation algorithm to engineering applications and to be applicable to non-gaussian measured noise environments, the following embodiments provide an INS/CNS integrated navigation method, system, storage medium and device applicable to non-gaussian measured noise environments, and the INS/CNS integrated navigation system is trained by using the neural network and using the attitude error, position error and refractive vision height error of the INS and the CNS as observed quantities, so that the INS/CNS integrated navigation system has a function of predicting the measured noise variance and the optimal estimation error value; under the condition that the measured noise is non-Gaussian noise, a variance matrix of the measured noise is predicted in real time by using a neural network, the optimal estimation error value of the CKF is predicted and corrected based on the predicted measured variance matrix, the carrier/target attitude, speed and position information output by the INS are corrected based on the corrected optimal estimation value, and finally the INS/CNS integrated navigation system can output high-precision navigation information under the non-Gaussian noise measuring environment.
The first embodiment is as follows:
the present embodiment aims to provide an INS/CNS integrated navigation method, comprising the following steps:
(1) in an initial training stage, a maximum correlation entropy generalized high-order volume Kalman filter (MCGHCKF) in a subsystem 1 and a volume Kalman filter (CKF) in a subsystem 2 respectively complete the training of an LSTM neural network contained in the same subsystem by taking attitude errors, position errors and refraction vision height errors of INS and CNS as observed quantities, so that the LSTM neural network respectively has the prediction functions of a measurement noise variance and an optimal estimation error value of the Kalman filter 2;
(2) measuring the real-time estimation and error compensation of the noise variance: under the condition that the measurement noise is non-Gaussian noise, the LSTM neural network in the subsystem 1 is used for predicting the variance matrix of the measurement noise in real time, the predicted measurement variance matrix is sent to the CKF in the subsystem 2, and meanwhile, the LSTM neural network in the subsystem 2 predicts and corrects the optimal estimation error value of the CKF;
(3) and (3) correcting the attitude, speed and position information of the carrier/target output by the INS by using the CKF optimal estimation value after error correction in the step (2), and finally realizing that the INS/CNS integrated navigation system can output high-precision navigation information under the non-Gaussian measurement noise environment.
The process of the step (1) comprises the following steps:
(11) in the initial training stage, the subsystem 1 takes a platform misalignment angle, a speed error, a position error, a gyro constant drift and an accelerometer constant bias as state quantities, the difference between attitude, position and apparent height data solved by the CNS and attitude, position and apparent height data solved by the INS is taken as system observation measurement, optimal values of attitude error delta theta, speed error delta v and position error delta P of INS output data are filtered and estimated by using the MCGHCKF, and then a filter gain sequence [ K ] obtained at the first n moments in the filtering process is usedk-1,Kk-2,...,Kk-n]And a measurement noise variance matrix R obtained in the filtering process at the current momentkRespectively serving as input samples and output samples to train LSTM-1, processing input information through a forgetting gate in an LSTM-1 neural network and updating weights in the training process, resolving through an output gate, and outputting an optimal learning training result, wherein the output is R'k;
(12) The subsystem 2 also takes a platform misalignment angle, a speed error, a position error, a gyro constant drift and an accelerometer constant offset as state quantities, and the difference between the posture, the position and the apparent height data solved by the CNS and the posture, the position and the apparent height data solved by the INS as a system observation measurement, and the optimal training result R 'of the LSTM-1 neural network is obtained'kInputting the data into a CKF in the subsystem 2, and performing optimal filtering estimation on the system error of the INS by using the CKF to obtain optimal values of an attitude error delta theta ', a speed error delta v ' and a position error delta P ';
(13) and (3) subtracting the attitude error, the speed error and the position error obtained through the filtering process of the subsystem 1 and the subsystem 2 to obtain delta theta ', delta v ' and delta P ':
then the filter gain K 'of the current moment obtained in the filtering process of the subsystem 2 is obtained'kAnd [ δ θ ', δ P', δ v ″ ]]The training is respectively used as an input sample and an output sample of the LSTM-2, the input information is processed and the weight is updated through a forgetting gate in the LSTM-2 neural network in the training process, and the optimal learning training result is output after the calculation of an output gate.
The process of the step (2) comprises the following steps:
when the measurement noise is non-Gaussian noise, the MCGHCKF in the subsystem 1 does not work any more, and the filter gain sequence [ K 'of the first n time instants obtained by the CKF in the subsystem 2 is used'k-1,K′k-2,...,K′k-n]Inputting the measured noise into the LSTM-1 after training, and predicting a variance matrix R 'of the measured noise at the current time by the LSTM-1'k(ii) a CKF in subsystem 2 is then R'kThe filtering estimation of INS system errors delta theta ', delta v ' and delta P ' can be finished, and the filtering gain K ' of the current moment is obtained 'kPrepared from K'kAs the input of the LSTM-2, the LSTM-2 can predict error values delta theta ', delta v ' and delta P ' of the optimal estimation of the CKF at the current moment; finally, correcting the INS system error estimated by the CKF by using the predicted error value to obtain a corrected attitude error delta theta1Velocity error δ v1And position error deltaP1。
The process of the step (3) comprises the following steps:
using the CKF optimal estimated value delta theta after error correction in the step (2)1、δv1And δ P1Attitude information θ of carrier/target solved by INSINS(k) Velocity information vINS(k) And position information PINS(k) Correction is performed so that the INS/CNS integrated navigation system outputs highly accurate attitude information θ'INS(k) And speed information v'INS(k) And position information P'INS(k)。
The specific process of the steps is as follows:
(1) as shown in FIG. 1, in the initial training phase, the subsystem 1 takes the platform misalignment angle, the speed error, the position error, the gyro constant drift and the accelerometer constant bias as state quantities, and the attitude theta of the CNS outputCNS(k) Position PCNS(k) Apparent height hCNS(k) Information and INS output attitude θINS(k) Position PINS(k) And a height of view hINS(k) And (4) establishing an INS/CNS integrated navigation system model shown in a formula (7) by taking the difference value of the information as observed quantity.
Wherein,representing a state vector of a dimension n,represents an m-dimensional measurement vector, andf (-) represents a nonlinear system function, wk-1And vkRespectively representing process noise and measurement noise, and satisfying E (w)k)=qk,E(vk)=rkAndδkjrepresenting the kronecker function.
And optimally estimating the attitude error delta theta, the speed error delta v and the position error delta P of the INS output data by adopting an MCGHCKF algorithm according to the INS/CNS integrated navigation system equation. The volume point is calculated by performing Cholesky decomposition on the state covariance:
Sk-1|k-1=Chol(Pk-1) (8)
wherein Chol (. cndot.) represents Cholesky decomposition,[1]ia set of representations [1]The ith column;indicating the state optimum estimate at time k-1.
Calculating a propagation volume point through a nonlinear system function to obtain:
predicting the state value at the time k to obtain:
the predicted value of state covariance at time k can be expressed as:
generating a volume point X according to a predicted value of the state covariance at the time ki,k|k-1:
Sk|k-1=Chol(Pk|k-1) (13)
The volume points are transferred by a metrology function:
Zi,k|k-1=HXi,k|k-1 (15)
updating and estimating a variance matrix of the measurement noise according to a maximum correlation entropy criterion:
wherein M isr,kBy comparing R before updatekIs obtained by performing Cholesky decomposition on the raw materials,Gσ(. represents a Gaussian kernel function, e)i,k=di,k-gi(xk),di,kRepresents DkI element of (2), gi(xk) Denotes g (x)k) The (i) th element of (a),
by predicting the measurement value and the covariance of the measurement value at the time k by equations (17) and (18), respectively, it is possible to obtain:
and predicting the cross covariance matrix at the k moment:
according to Pzz,k|k-1And Pxz,k|k-1Calculating a filtering gain at the k moment:
wherein the estimated state valueThe error amounts include an INS attitude error δ θ, a velocity error δ v, a position error δ P, and the like.
In the initial training stage, the filtering process of the MCGHCKF algorithm is continuously updated and executed, and then the filtering gain sequence [ K ] obtained at the first n moments in the filtering processk-1,Kk-2,...,Kk-n]And a measurement noise variance matrix R obtained in the filtering process at the current momentkThe LSTM-1 is trained as an input sample and an output sample respectively, input information is processed and weight is updated through a forgetting gate in an LSTM-1 neural network in the training process, and an optimal learning training result is output after the input information is resolved through an output gate.
Simultaneously with LSTM-1 training, optimizing the LSTM-1 neural network training result R'kInput into the CKF in the subsystem 2,the subsystem 2 also adopts a system equation shown in the formula (7) to perform optimal filtering estimation on the systematic error of the INS by using the CKF. By the pair-state covariance P'k-1Performing Cholesky decomposition to calculate volume points:
S′k-1=Chol(P′k-1) (23)
wherein Chol (. cndot.) represents Cholesky decomposition,[1]ia set of representations [1]The ith column;indicating the state optimum estimate at time k-1.
Calculating the propagation volume point by the nonlinear state function, we can get:
predicting the state value at the time k to obtain:
the predicted value of state covariance at time k can be expressed as:
generating a volume point X 'according to the state predicted value at the time k'i,k|k-1。
S′k|k-1=Chol(P′k|k-1) (28)
The volume points are transferred by a metrology function:
Z′i,k|k-1=HX′i,k|k-1 (30)
the measurement value and the measurement value covariance at the time k are predicted by equations (31) and (32), respectively, and the following results are obtained:
and predicting the cross covariance matrix at the k moment:
according to P'zz,k|k-1And P'xz,k|k-1Calculating filter gain K 'at moment K'k。
K′k=P′xz,k|k-1(P′zz,k|k-1)-1 (34)
The state estimate at time k can be expressed as:
the state covariance estimate at time k can be expressed as:
P′k=P′k|k-1-K′kP′zz,k|k-1(K′k)T (36)
according to the above CKFThe optimal estimated value of the state vector of the system at the moment k can be obtained in the filtering processIt is composed ofThe INS error amounts include an attitude error δ θ ', a velocity error δ v ', a position error δ P ', and the like.
And (3) subtracting the attitude error, the speed error and the position error obtained through the filtering process of the subsystem 1 and the subsystem 2 to obtain delta theta ', delta v ' and delta P ':
then the filter gain K 'of the current moment obtained in the filtering process of the subsystem 2 is obtained'kAnd [ δ θ ', δ P', δ v ″ ]]The training is respectively used as an input sample and an output sample of the LSTM-2, the input information is processed and the weight is updated through a forgetting gate in the LSTM-2 neural network in the training process, and the optimal learning training result is output after the calculation of an output gate.
(2) As shown in fig. 2, during the real-time estimation and error compensation steps of the variance of the measured noise. When the measurement noise is non-Gaussian noise, the MCGHCKF in the subsystem 1 does not work any more, and the filter gain sequence [ K 'of the first n time moments obtained by the CKF in the subsystem 2 is used'k-1,K′k-2,...,K′k-n]Inputting the measured noise into the LSTM-1 after training, and predicting a variance matrix R 'of the measured noise at the current time by the LSTM-1'k(ii) a CKF in subsystem 2 is then R'kThe filtering estimation of INS system errors delta theta ', delta v ' and delta P ' can be finished, and the filtering gain K ' of the current moment is obtained 'kPrepared from K'kAs the input of the LSTM-2, the LSTM-2 can predict error values δ θ ", δ v", and δ P "of the optimal estimation of CKF at the current time; finally, correcting the INS system error estimated by the CKF by using the predicted error value to obtain a corrected attitude error delta theta1Velocity error δ v1And position error deltaP1。
(3) Using the optimal estimated value delta theta of the CKF after the error is corrected in the step (2)1、δv1And δ P1Attitude information θ of carrier/target solved by INSINS(k) Velocity information vINS(k) And position information PINS(k) Correction is performed so that the INS/CNS integrated navigation system outputs highly accurate attitude information θ'INS(k) And speed information v'INS(k) And position information P'INS(k)。
The INS/CNS integrated navigation method applicable to the non-Gaussian measurement noise environment is provided in the process, and the problem that the INS/CNS integrated navigation system is low in navigation accuracy in the non-Gaussian measurement noise environment is solved.
Compared with an INS/CNS integrated navigation algorithm based on an information theory optimization criterion, the execution efficiency of the navigation process is obviously improved.
Example two:
it is an object of this embodiment to provide an INS/CNS integrated navigation system comprising:
a prediction module configured to: acquiring attitude, speed and position information of a target, and acquiring a non-Gaussian measurement noise variance and a predicted value of an optimal estimation error in the attitude, speed and position information based on a trained neural network;
a compensation module configured to: correcting the optimal estimation error value in the INS/CNS integrated navigation system based on the non-Gaussian measured noise variance and the predicted value of the optimal estimation error;
an output module configured to: and correcting the output target attitude, speed and position information based on the corrected optimal estimated error value, thereby obtaining the navigation information output by the INS/CNS integrated navigation system.
The INS/CNS integrated navigation method can be suitable for the non-Gaussian measured noise environment, and solves the problem of low navigation accuracy of the INS/CNS integrated navigation system in the non-Gaussian measured noise environment. Compared with an INS/CNS integrated navigation algorithm based on an information theory optimization criterion, the execution efficiency of the navigation process is obviously improved.
Example three:
the present embodiment provides a computer-readable storage medium, on which a computer program is stored, which when executed by a processor implements the steps in the INS/CNS combination navigation method according to the first embodiment.
The INS/CNS integrated navigation method can be suitable for the non-Gaussian measured noise environment, and solves the problem of low navigation accuracy of the INS/CNS integrated navigation system in the non-Gaussian measured noise environment. Compared with an INS/CNS integrated navigation algorithm based on an information theory optimization criterion, the execution efficiency of the navigation process is obviously improved.
Example four:
the present embodiment provides a computer apparatus comprising a memory, a processor and a computer program stored in the memory and executable on the processor, wherein the processor executes the computer program to implement the steps of the combined INS/CNS navigation method according to the first embodiment.
The INS/CNS integrated navigation method can be suitable for the non-Gaussian measured noise environment, and solves the problem of low navigation accuracy of the INS/CNS integrated navigation system in the non-Gaussian measured noise environment. Compared with an INS/CNS integrated navigation algorithm based on an information theory optimization criterion, the execution efficiency of the navigation process is obviously improved.
The steps or modules related to the second to fourth embodiments correspond to those of the first embodiment, and the detailed description thereof can be found in the relevant description of the first embodiment. The term "computer-readable storage medium" should be taken to include a single medium or multiple media containing one or more sets of instructions; it should also be understood to include any medium that is capable of storing, encoding or carrying a set of instructions for execution by a processor and that cause the processor to perform any of the methods of the present invention.
The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention, and various modifications and changes may be made by those skilled in the art. Any modification, equivalent replacement, or improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.
Claims (10)
- An INS/CNS integrated navigation method, characterized by: the method comprises the following steps:acquiring attitude, speed and position information of a target, and acquiring a non-Gaussian measurement noise variance and a predicted value of an optimal estimation error in the attitude, speed and position information based on a trained neural network;correcting the optimal estimation error value in the INS/CNS integrated navigation system based on the non-Gaussian measured noise variance and the predicted value of the optimal estimation error;and correcting the output target attitude, speed and position information based on the corrected optimal estimated error value, thereby obtaining the navigation information output by the INS/CNS integrated navigation system.
- 2. The INS/CNS combination navigation method of claim 1, wherein: the training process of the neural network comprises the steps that a first subsystem of the INS/CNS integrated navigation system takes a platform misalignment angle, a speed error, a position error, gyro constant drift and accelerometer constant bias as state quantities, and the difference between attitude, position and apparent height data output by the astronomical navigation system and attitude, position and apparent height data output by the inertial navigation system is observed quantity, so that an INS/CNS integrated navigation system model is constructed.
- 3. The INS/CNS combination navigation method of claim 2, wherein: the training process of the neural network further comprises the step of obtaining the optimal filtering estimation value of attitude error, speed error and position error in the output data of the inertial navigation system by utilizing the Kalman filtering algorithm of the maximum correlation entropy based on the INS/CNS integrated navigation system model.
- 4. The INS/CNS combined navigation method according to claim 3, wherein: the training process of the neural network further comprises the steps of training the neural network of the first subsystem by respectively using the filter gain sequence obtained at the first n moments in the filtering process and the measurement noise variance matrix obtained in the filtering process at the current moment as input and output samples, and outputting an optimal learning training result, wherein n is more than or equal to 1.
- 5. The INS/CNS combined navigation method according to claim 4, wherein: the training process of the neural network further comprises the steps that a second subsystem of the INS/CNS integrated navigation system takes a platform misalignment angle, a speed error, a position error, gyro constant drift and accelerometer constant bias as state quantities, the difference between attitude, position and apparent height data output by the astronomical navigation system and attitude, position and apparent height data output by the inertial navigation system is taken as system observation measurement, the optimal training result of the neural network of the first subsystem is input into a volume Kalman filter of the second subsystem, and optimal filtering estimation is carried out on the error of the inertial navigation system to obtain the optimal values of the attitude error, the speed error and the position error.
- 6. The INS/CNS combined navigation method according to claim 5, wherein: the training process of the neural network further comprises the steps of obtaining the difference value of the attitude error, the speed error and the position error of the first subsystem and the second subsystem, respectively serving as the input sample and the output sample of the neural network of the second subsystem for training based on the difference value and the filtering gain of the second subsystem at the current moment, and outputting the optimal learning training result.
- 7. The INS/CNS combination navigation method of claim 1, wherein: the process of measuring the noise variance real-time estimation and error compensation comprises the steps that under the condition that the measured noise is non-Gaussian noise, the filter gain sequence of the first n moments in the second subsystem is input into the trained neural network of the first subsystem, and the variance matrix of the measured noise at the current moment is predicted, wherein n is more than or equal to 1; the second subsystem obtains a filtering estimation value of a system error based on a variance matrix of the measured noise at the current moment, obtains a filtering gain at the current moment, takes the filtering gain as the input of a neural network of the second subsystem, and predicts an error value of optimal estimation at the current moment; and correcting the system error of the inertial navigation system based on the predicted error value to obtain a corrected attitude error, a corrected speed error and a corrected position error.
- An INS/CNS integrated navigation system comprising:a prediction module configured to: acquiring attitude, speed and position information of a target, and acquiring a non-Gaussian measurement noise variance and a predicted value of an optimal estimation error in the attitude, speed and position information based on a trained neural network;a compensation module configured to: correcting the optimal estimation error value in the INS/CNS integrated navigation system based on the non-Gaussian measured noise variance and the predicted value of the optimal estimation error;an output module configured to: and correcting the output target attitude, speed and position information based on the corrected optimal estimated error value, thereby obtaining the navigation information output by the INS/CNS integrated navigation system.
- 9. A computer readable storage medium having stored thereon a computer program which, when executed by a processor, performs the steps of the INS/CNS combination navigation method according to any one of claims 1 to 7.
- 10. A computer device comprising a memory, a processor and a computer program stored on the memory and executable on the processor, wherein the processor when executing the program performs the steps in the INS/CNS combination navigation method according to any of claims 1-7.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110898503.5A CN113447019B (en) | 2021-08-05 | 2021-08-05 | INS/CNS integrated navigation method, system, storage medium and equipment |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110898503.5A CN113447019B (en) | 2021-08-05 | 2021-08-05 | INS/CNS integrated navigation method, system, storage medium and equipment |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113447019A true CN113447019A (en) | 2021-09-28 |
CN113447019B CN113447019B (en) | 2023-01-13 |
Family
ID=77818215
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110898503.5A Active CN113447019B (en) | 2021-08-05 | 2021-08-05 | INS/CNS integrated navigation method, system, storage medium and equipment |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113447019B (en) |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101826852A (en) * | 2010-03-11 | 2010-09-08 | 哈尔滨工程大学 | Unscented particle filtering method based on particle swarm optimization algorithm |
CN103363993A (en) * | 2013-07-06 | 2013-10-23 | 西北工业大学 | Airplane angular rate signal reconstruction method based on unscented kalman filter |
CN105737832A (en) * | 2016-03-22 | 2016-07-06 | 北京工业大学 | Distributed SLAM (simultaneous localization and mapping) method on basis of global optimal data fusion |
WO2017088196A1 (en) * | 2015-11-24 | 2017-06-01 | 东南大学 | Fusion navigation device and method based on wireless fingerprints and mems sensor |
CN107390246A (en) * | 2017-07-06 | 2017-11-24 | 电子科技大学 | A kind of GPS/INS Combinated navigation methods based on genetic neural network |
CN108562290A (en) * | 2018-07-13 | 2018-09-21 | 深圳市戴升智能科技有限公司 | Filtering method, device, computer equipment and the storage medium of navigation data |
CN109459040A (en) * | 2019-01-14 | 2019-03-12 | 哈尔滨工程大学 | More AUV co-located methods based on RBF neural auxiliary volume Kalman filtering |
CN110222783A (en) * | 2019-06-13 | 2019-09-10 | 南京信息工程大学 | Ground and spaceborne radar precipitation data fusion method based on wavelet field regularization |
CN110632634A (en) * | 2019-09-24 | 2019-12-31 | 东南大学 | Optimal data fusion method suitable for ballistic missile INS/CNS/GNSS combined navigation system |
CN111156987A (en) * | 2019-12-18 | 2020-05-15 | 东南大学 | Inertia/astronomical combined navigation method based on residual compensation multi-rate CKF |
-
2021
- 2021-08-05 CN CN202110898503.5A patent/CN113447019B/en active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101826852A (en) * | 2010-03-11 | 2010-09-08 | 哈尔滨工程大学 | Unscented particle filtering method based on particle swarm optimization algorithm |
CN103363993A (en) * | 2013-07-06 | 2013-10-23 | 西北工业大学 | Airplane angular rate signal reconstruction method based on unscented kalman filter |
WO2017088196A1 (en) * | 2015-11-24 | 2017-06-01 | 东南大学 | Fusion navigation device and method based on wireless fingerprints and mems sensor |
CN105737832A (en) * | 2016-03-22 | 2016-07-06 | 北京工业大学 | Distributed SLAM (simultaneous localization and mapping) method on basis of global optimal data fusion |
CN107390246A (en) * | 2017-07-06 | 2017-11-24 | 电子科技大学 | A kind of GPS/INS Combinated navigation methods based on genetic neural network |
CN108562290A (en) * | 2018-07-13 | 2018-09-21 | 深圳市戴升智能科技有限公司 | Filtering method, device, computer equipment and the storage medium of navigation data |
CN109459040A (en) * | 2019-01-14 | 2019-03-12 | 哈尔滨工程大学 | More AUV co-located methods based on RBF neural auxiliary volume Kalman filtering |
CN110222783A (en) * | 2019-06-13 | 2019-09-10 | 南京信息工程大学 | Ground and spaceborne radar precipitation data fusion method based on wavelet field regularization |
CN110632634A (en) * | 2019-09-24 | 2019-12-31 | 东南大学 | Optimal data fusion method suitable for ballistic missile INS/CNS/GNSS combined navigation system |
CN111156987A (en) * | 2019-12-18 | 2020-05-15 | 东南大学 | Inertia/astronomical combined navigation method based on residual compensation multi-rate CKF |
Non-Patent Citations (4)
Title |
---|
DI LIU: "A novel optimal data fusion algorithm and its application for the integrated navigation system of missile", 《CHINESE SOCIETY OF AERONAUTICS AND ASTRONAUTICS & BEIHANG UNIVERSITY CHINESE JOURNAL OF AERONAUTICS》 * |
DI LIU: "An ANN-Based Data Fusion Algorithm for INS/CNS Integrated Navigation System", 《IEEE SENSORS JOURNAL》 * |
李海龙: "INS/GNSS/Odometer车辆组合导航***信息融合方法研究", 《中国优秀硕士学位论文全文数据库 工程科技II辑》 * |
杜小菁: "基于组合导航技术的粒子滤波改进方法综述", 《2017第三节电气工程与工业工程国际会议论文集》 * |
Also Published As
Publication number | Publication date |
---|---|
CN113447019B (en) | 2023-01-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110109470B (en) | Combined attitude determination method based on unscented Kalman filtering and satellite attitude control system | |
CN102654404B (en) | Method for improving resolving precision and anti-jamming capability of attitude heading reference system | |
CN111156987B (en) | Inertia/astronomy combined navigation method based on residual compensation multi-rate CKF | |
CN108827310B (en) | Marine star sensor auxiliary gyroscope online calibration method | |
CN105737823B (en) | A kind of GPS/SINS/CNS Combinated navigation methods based on five rank CKF | |
CN104655131B (en) | Inertial navigation Initial Alignment Method based on ISTSSRCKF | |
CN106772524B (en) | A kind of agricultural robot integrated navigation information fusion method based on order filtering | |
Gross et al. | A comparison of extended Kalman filter, sigma-point Kalman filter, and particle filter in GPS/INS sensor fusion | |
CN107618678B (en) | Attitude control information joint estimation method under satellite attitude angle deviation | |
CN112146655B (en) | Elastic model design method for BeiDou/SINS tight integrated navigation system | |
CN113155129B (en) | Holder attitude estimation method based on extended Kalman filtering | |
CN110044385B (en) | Rapid transfer alignment method under condition of large misalignment angle | |
CN112504298A (en) | GNSS-assisted DVL error calibration method | |
CN111141313A (en) | Method for improving matching transfer alignment precision of airborne local relative attitude | |
CN113587926A (en) | Spacecraft space autonomous rendezvous and docking relative navigation method | |
Sun et al. | A robust indirect Kalman filter based on the gradient descent algorithm for attitude estimation during dynamic conditions | |
CN114323007A (en) | Carrier motion state estimation method and device | |
CN116734864B (en) | Autonomous relative navigation method for spacecraft under constant observed deviation condition | |
CN113447019B (en) | INS/CNS integrated navigation method, system, storage medium and equipment | |
Sang et al. | Invariant cubature kalman filtering-based visual-inertial odometry for Robot pose estimation | |
CN111854741A (en) | GNSS/INS tight combination filter and navigation method | |
Wang et al. | A line-of-sight rate estimation method for roll-pitch gimballed infrared seeker | |
CN113252029B (en) | Astronomical navigation attitude transfer method based on optical gyroscope measurement information | |
CN113447018B (en) | Real-time attitude estimation method of underwater inertial navigation system | |
Cao et al. | Adaptive predictive variable structure filter for attitude synchronization estimation |
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 |