Error prediction method for inertial navigation equipment
By embedding the IMU physical drift formula and environmental error into the LSTM model, and combining dynamic adaptation mechanism and reinforcement learning optimization, the problem of inertial navigation system adapting in complex environments is solved, and the output of high-precision navigation data is achieved.
Patent Information
- Application Number
- CN202411915638.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-12-24
- Publication Date
- 2025-04-04
- Estimated Expiration
- 2044-12-24
AI Technical Summary
The existing inertial navigation systems are difficult to adapt in real time in complex dynamic environments, and traditional Kalman filters cannot effectively deal with the problems of ambient temperature changes and GNSS signal instability.
By directly embedding the IMU physical drift formula and environmental error into the LSTM model, and combining dynamic adaptive mechanisms and reinforcement learning optimization, error prediction results are generated and noise covariance matrix is optimized, and the real-time and accuracy of the navigation system are improved.
It improves the real-time and accuracy of the navigation system, enhances the adaptability to dynamic environments, and realizes model self-learning and performance iteration.
Smart Images

Figure CN119756426A_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of inertial positioning, and in particular relates to a method for error prediction of an inertial navigation device. Background Art
[0002] Inertial Navigation System (INS) combines IMU sensors with GNSS receivers to achieve precise navigation. However, IMU sensors are susceptible to drift errors, GNSS signals are unstable in occluded environments, and ambient temperature changes can also affect navigation accuracy. In existing technologies, inertial navigation often uses Kalman filtering to fuse data, or relies on data-driven deep learning models, but both have shortcomings:
[0003] 1. Traditional Kalman filters cannot adapt to complex dynamic environments in real time.
[0004] 2. Purely data-driven models lack physical constraints, making it difficult to explain the results and prone to failure under external disturbances. Summary of the invention
[0005] The purpose of the present invention is to provide a method for error prediction of an inertial navigation device, which solves the technical problem of improving the real-time and accuracy of a navigation system by directly embedding an IMU physical drift formula and environmental error into an LSTM model, combining a dynamic adaptive mechanism and reinforcement learning optimization.
[0006] To achieve the above purpose, the present invention adopts the following technical inventions:
[0007] A method for error prediction of an inertial navigation device comprises the following steps:
[0008] Step 1: The data acquisition module obtains IMU data P from the IMU sensor, GNSS receiver and environmental sensor respectively IMU (t), GNSS positioning data P GNSS (t) and ambient temperature data T env (t), and preprocessing; IMU data PIMU (t) includes acceleration a (t) and angular velocity ω (t);
[0009] Preprocessing includes IMU data P IMU (t) Noise filtering is performed on the ambient temperature data T env (t) is smoothed and the IMU data P is aligned using the timestamp IMU (t) and GNSS positioning data P GNSS (t), and interpolate and extend the GNSS positioning data P GNSS (t) to IMU data P IMU (t) time frequency; time interval error E ΔtPerform mathematical modeling; the preprocessed data and time interval error E Δt Combine and obtain the feature vector X(t);
[0010] Step 2: Data fusion module for IMU data P IMU (t) drift error E IMU (t) and the temperature error E of the ambient temperature data T Mathematical modeling is performed respectively according to the drift error E IMU (t), temperature error E T and time interval error E Δt , generate the initial fusion error E 融合 (t); the drift error E IMU (t) and temperature error E T Add to the feature vector X(t);
[0011] Step 3: The LSTM calculation module retrieves the feature vector X(t) and the fusion error E 融合 (t), using the LSTM model and physical constraints to predict sensor errors, we get the error prediction result E LSTM (t);
[0012] Step 4: Optimize the module to obtain real-time ambient temperature data T env (t), IMU signal-to-noise ratio SNR IMU And the error prediction result E LSTM (t) Establish a dynamic adaptive mechanism to adjust the noise covariance matrix according to environmental changes, use reinforcement learning optimization method to establish a reward function, dynamically adjust the LSTM weights and noise covariance matrix, obtain the optimized LSTM model weights and dynamically adjusted noise covariance matrix, and improve the real-time performance of error prediction and correction;
[0013] Step 5: Use the prediction error to correct the inertial data and continuously optimize the model through a feedback mechanism to output high-precision navigation data.
[0014] Preferably, when executing step 1, the feature vector X(t) is represented by the following formula:
[0015] X(t)=[a(t),ω(t),P GNSS (t),T env (t),E Δt ];
[0016] Time interval error E Δt Calculated by the following formula:
[0017] E Δt =β×Δt;
[0018] Among them, Δt is the time interval, which represents the IMU data P IMU (t) and GNSS positioning data P GNSS (t) is the time synchronization error at the same time; β is the time error influence coefficient, which represents the influence of the time delay between sensors.
[0019] Preferably, when executing step 2, the specific steps are as follows:
[0020] Step 2-1: IMU data P IMU (t) drift error E IMU (t) Modeling, as shown in the following formula:
[0021] E IMU (t) = E IMU (t-1)+α×Δt;
[0022] Among them, E IMU (t) is the IMU error at the current time point t, E IMU (t-1) is the IMU error at the previous time point t-1, α is the drift rate, and Δt is the time interval;
[0023] Step 2-2: Temperature error E of ambient temperature data T Modeling, as shown in the following formula:
[0024] E T =γ×(T env -T0);
[0025] Among them, T env is the ambient temperature, T0 is the calibration temperature of the ambient sensor, γ is the temperature sensitivity coefficient; the ambient sensor is a temperature sensor;
[0026] Step 2-3: Convert the drift error E IMU (t), temperature error E T and time interval error E Δt Fusion is performed to obtain the fusion error E 融合 (t):
[0027] E 融合 (t) = E IMU (t)+E T +E Δt ;
[0028] Step 2-4: Convert the drift error E IMU (t) and temperature error E T After being added to the feature vector X(t), the feature vector X(t) is expressed as follows:
[0029] X(t)=[a(t),ω(t),P GNSS(t),T env (t),E IMU (t),E T ,E Δt ].
[0030] Preferably, when executing step 3, the specific steps are as follows:
[0031] Step 3-1: Feature input, specifically, taking the feature vector X(t) obtained in step 2-4 as the feature vector input into the input layer of the LSTM model;
[0032] Step 3-2: Embed physical constraints in the LSTM model, specifically by transforming the drift error formula E IMU (t) = E IMU (t-1)+α×Δt and temperature error formula E T =γ×(T env -T0) is directly embedded in the input and gating mechanism of the LSTM model;
[0033] Introduce drift rate α and time interval β in the forget gate;
[0034] LSTM model fitting prediction result E LSTM1 (t);
[0035] Step 3-3: Physical constraint regularization, specifically introducing the regularization term L phy Constrain the LSTM loss function:
[0036] L phy =λ phy ×||E L (t)-(E IMU (t)+E T +E Δt )|| 2 ;
[0037] Among them, E L (t) is the error calculation of the intermediate process, which is used to constrain the degree of compliance of the LSTM model with physical laws; λ phy is the regularization coefficient, which adjusts the strength of the physical error constraint;
[0038] Physical constraint regularization is used to encourage the prediction results E LSTM1 (t) satisfy physical constraints;
[0039] Step 3-4: Combine the error loss and physical regularization loss to optimize the LSTM model weights and generate the final prediction result E LSTM (t), the total loss function L of LSTM is:
[0040] L total =Ldata +λL phy ;
[0041] L data =||E true (t)-E LSTM1 (t)|| 2 ;
[0042] Among them, λ is the weight factor, L data is the error loss based on the data.
[0043] Preferably, when executing step 4, the following steps are specifically included:
[0044] Step 4-1: Get real-time ambient temperature data T env (t), IMU signal-to-noise ratio SNR IMU And the prediction result E LSTM (t);
[0045] Step 4-2: Establish a dynamic adaptive mechanism to adjust the noise covariance matrix according to environmental changes:
[0046] Q adaptive =Q0+k1×|T env -T0|;
[0047] R adaptive =R0+k2×SNR IMU ;
[0048] Among them, Q adaptive is the process noise covariance matrix, which is affected by temperature changes; R adaptive is the measurement noise covariance matrix, which is affected by the signal-to-noise ratio; k1 and k2 are adjustment coefficients; Q0 is the initial value of the process noise covariance matrix; R0 is the initial value of the measurement noise covariance matrix;
[0049] Step 4-3: Use reinforcement learning optimization method to establish reward function Reward:
[0050] Reward=-||E true (t)-E LSTM (t)|| 2 ;
[0051] The LSTM weights and Kalman filter covariance matrix are dynamically adjusted through the reward function Reward to optimize the LSTM model and noise covariance matrix.
[0052] Preferably, when executing step 5, the IMU data P is calculated according to the following formula: IMU (t) Make corrections to obtain the corrected navigation data P corrected (t):
[0053] P corrected (t) = P IMU (t)-E LSTM (t);
[0054] The corrected data is used to update the parameters of the LSTM model and the Kalman filter to continuously optimize the model through the feedback mechanism, and the navigation data P is output. corrected (t).
[0055] The error prediction method of an inertial navigation device disclosed in the present invention solves the technical problem of improving the real-time performance and accuracy of a navigation system by directly embedding an IMU physical drift formula and an environmental error into an LSTM model, combining a dynamic adaptive mechanism and reinforcement learning optimization. The present invention integrates the IMU drift formula and the environmental temperature error modeling, enhances the prediction accuracy and gives the model a physical interpretation power, adjusts the noise covariance matrix according to the environmental temperature change and the IMU signal-to-noise ratio, improves the adaptability of the system to a dynamic environment, uses the real-time error as a reward signal, dynamically optimizes the LSTM weight and the covariance matrix, improves the prediction capability under long-term operation, performs feedback optimization on the corrected navigation data, and realizes model self-learning and performance iteration. BRIEF DESCRIPTION OF THE DRAWINGS
[0056] Figure 1 It is the main flow chart of the present invention;
[0057] Figure 2 is a flow chart of step 1 of the present invention;
[0058] Figure 3 is a flow chart of step 2 of the present invention;
[0059] Figure 4 is a flow chart of step 3 of the present invention;
[0060] Figure 5 is a flow chart of step 4 of the present invention;
[0061] Figure 6 It is a flow chart of step 5 of the present invention. DETAILED DESCRIPTION
[0062] Depend on Figure 1-Figure 6 A method for error prediction of an inertial navigation device is shown, comprising the following steps:
[0063] Step 1: The data acquisition module obtains IMU data P from the IMU sensor, GNSS receiver and environmental sensor respectively IMU (t), GNSS positioning data P GNSS (t) and ambient temperature data T env (t), and preprocessing; IMU data P IMU(t) includes acceleration a(t) and angular velocity ω(t);
[0064] Preprocessing includes IMU data P IMU (t) Noise filtering is performed on the ambient temperature data T env (t) is smoothed and the IMU data P is aligned using the timestamp IMU (t) and GNSS positioning data P GNSS (t), and interpolate and extend the GNSS positioning data P GNSS (t) to IMU data P IMU (t) time frequency; time interval error E Δt Perform mathematical modeling; the preprocessed data and time interval error E Δt Combine and obtain the feature vector X(t);
[0065] When executing step 1, the feature vector X(t) is expressed by the following formula:
[0066] X(t)=[a(t),ω(t),P GNSS (t),T env (t),E Δt ];
[0067] Time interval error E Δt Calculated by the following formula:
[0068] E Δt =β×Δt;
[0069] Among them, Δt is the time interval, which represents the IMU data P IMU (t) and GNSS positioning data P GNSS (t) is the time synchronization error at the same time; β is the time error influence coefficient, which represents the influence of the time delay between sensors.
[0070] In the application process, the data sampling frequencies of IMU sensors and GNSS receivers are usually different. The sampling frequency of IMU sensors is higher (such as 100Hz or higher), while the sampling frequency of GNSS receivers is lower (such as 1Hz); since the time bases of data collection of the two are not completely consistent, time deviation will occur.
[0071] The internal clocks of the IMU sensor and GNSS receiver may drift or be out of sync, which can also cause inconsistent timestamps.
[0072] Environmental factors such as temperature can also affect the internal clock, causing drift.
[0073] When interpolating GNSS data to the IMU frequency, additional time errors may also be introduced due to the imperfections of the interpolation algorithm.
[0074] The present invention corrects the above errors and reduces the time synchronization error Δt, thereby obtaining more accurate positioning data.
[0075] In this embodiment, the timestamp t of each IMU data is IMU and the corresponding GNSS data timestamp t GNSS Make a comparison.
[0076] Since the frequency of GNSS data is low, each data point of the IMU may correspond to multiple GNSS data points. In this case, the present embodiment uses interpolated GNSS data to align to the sampling time of the IMU.
[0077] The time interval Δt is the result of each comparison, which is the difference between the timestamp of the IMU sampling time and the corresponding GNSS data, that is:
[0078] Δt=t IMU -t GNSS ;
[0079] If the GNSS data does not exactly match the IMU timestamp, the GNSS data can be interpolated to get the closest timestamp t GNSS .
[0080] In this embodiment, various sensor data are standardized and aligned through preprocessing to provide data input in a unified format for subsequent modeling. Noise filtering and data smoothing improve data quality and reduce the interference of random errors on subsequent modeling. The GNSS data frequency is expanded by interpolation to be consistent with the IMU frequency, thereby reducing the problem of time resolution mismatch. The modeling of time interval error directly targets the problem of time asynchrony between sensors, thereby improving the accuracy of error prediction.
[0081] Step 2: Data fusion module for IMU data P IMU (t) drift error E IMU (t) and the temperature error E of the ambient temperature data T Mathematical modeling is performed respectively according to the drift error E IMU (t), temperature error E T and time interval error E Δt , generate the initial fusion error E 融合 (t); the drift error E IMU (t) and temperature error E T Add to the feature vector X(t);
[0082] When executing step 2, the specific steps are as follows:
[0083] Step 2-1: IMU data P IMU (t) drift error E IMU (t) Modeling, as shown in the following formula:
[0084] E IMU (t) = E IMU (t-1)+α×Δt;
[0085] Among them, E IMU (t) is the IMU error at the current time point t, E IMU (t-1) is the IMU error at the previous time point t-1, α is the drift rate, and Δt is the time interval;
[0086] Step 2-2: Temperature error E of ambient temperature data T Modeling, as shown in the following formula:
[0087] E T =γ×(T env -T0);
[0088] Among them, T env is the ambient temperature, T0 is the calibration temperature of the ambient sensor, γ is the temperature sensitivity coefficient; the ambient sensor is a temperature sensor;
[0089] Step 2-3: Convert the drift error E IMU (t), temperature error E T and time interval error E Δt Fusion is performed to obtain the fusion error E 融合 (t):
[0090] E 融合 (t) = E IMU (t)+E T +E Δt ;
[0091] Step 2-4: Convert the drift error E IMU (t) and temperature error E T After being added to the feature vector X(t), the feature vector X(t) is expressed as follows:
[0092] X(t)=[a(t),ω(t),P GNSS (t),T env (t),E IMU (t),E T ,E Δt ].
[0093] In this embodiment, the physical characteristics and environmental factors are decomposed into independent models, which helps to analyze the error source more intuitively. The ambient temperature error model (such as temperature sensitivity) allows the system to adapt to different working environments. 融合 (t) It provides a means of quickly estimating errors, providing a basic reference for subsequent complex models, adding physical errors to the feature vector, and enhancing the predictive ability of subsequent LSTM models.
[0094] Step 3: The LSTM calculation module retrieves the feature vector X(t) and the fusion error E 融合 (t), using the LSTM model and physical constraints to predict sensor errors, we get the error prediction result E LSTM (t);
[0095] When executing step 3, the specific steps are as follows:
[0096] Step 3-1: Feature input, specifically, taking the feature vector X(t) obtained in step 2-4 as the feature vector input into the input layer of the LSTM model;
[0097] Step 3-2: Embed physical constraints in the LSTM model, specifically by transforming the drift error formula E IMU (t) = E IMU (t-1)+α×Δt and temperature error formula E T =γ×(T env -T0) is directly embedded in the input and gating mechanism of the LSTM model;
[0098] Introduce drift rate α and time interval β in the forget gate;
[0099] LSTM model fitting prediction result E LSTM1 (t);
[0100] Step 3-3: Physical constraint regularization, specifically introducing the regularization term L phy Constrain the LSTM loss function:
[0101] L phy =λ phy ×||E L (t)-(E IMU (t)+E T +E Δt )|| 2 ;
[0102] Among them, E L (t) is the error calculation of the intermediate process, which is used to constrain the degree of compliance of the LSTM model with physical laws; λ phy is the regularization coefficient, which adjusts the strength of the physical error constraint;
[0103] Physical constraint regularization is used to encourage the prediction results E LSTM1 (t) satisfy physical constraints;
[0104] Step 3-4: Combine the error loss and physical regularization loss to optimize the LSTM model weights and generate the final prediction result E LSTM (t), the total loss function L of LSTM is:
[0105] L total =L data +λL phy ;
[0106] L data =||E true (t)-E LSTM1 (t)|| 2 ;
[0107] Among them, λ is the weight factor, L data is the error loss based on the data. In this embodiment, L data Represents the model prediction error E LSTM1 (t) and the actual error E true The goal is to minimize the loss function and optimize the parameters of the LSTM model so that the prediction result E LSTM1 (t) is closer to the true error E true (t);
[0108] E true (t) is the true error, which represents the deviation between the IMU sensor error in the actual measurement and the ground truth value. When training the LSTM model, E true (t) Pre-input precise position information P true (t) and IMU sensor measurement value P IMU (t); precise location information P true (t) obtained through a high-precision reference system, such as a high-precision GNSS system;
[0109] In this embodiment, when optimizing the LSTM model, the time synchronization error is embedded in the model as a feature, and the model automatically optimizes its influence on the error through learning; the physical constraint regularization term L phy Including E Δt , which encourages the prediction results of model fitting to satisfy the physical laws of time synchronization, thereby reducing the impact of time synchronization errors on the final results.
[0110] In this embodiment, data-driven and physical modeling are combined to make up for the lack of physical interpretability of traditional deep learning models. By regularizing physical constraints, the overfitting risk of the LSTM model during training is reduced and the accuracy of error prediction is improved. The LSTM model can learn dynamic patterns in time series data and can adapt to a variety of navigation scenarios. The total loss function combines physical errors and data errors to effectively balance the model's predictive ability and physical consistency.
[0111] Step 4: Optimize the module to obtain real-time ambient temperature data T env (t), IMU signal-to-noise ratio SNR IMU And the error prediction result E LSTM (t) Establish a dynamic adaptive mechanism to adjust the noise covariance matrix according to environmental changes, use reinforcement learning optimization method to establish a reward function, dynamically adjust the LSTM weights and noise covariance matrix, obtain the optimized LSTM model weights and dynamically adjusted noise covariance matrix, and improve the real-time performance of error prediction and correction;
[0112] When executing step 4, the specific steps include:
[0113] Step 4-1: Get real-time ambient temperature data T env (t), IMU signal-to-noise ratio SNR IMU And the prediction result E LSTM (t);
[0114] Step 4-2: Establish a dynamic adaptive mechanism to adjust the noise covariance matrix according to environmental changes:
[0115] Q adaptive =Q0+k1×|T env -T0|;
[0116] R adaptive =R0+k2×SNR IMU ;
[0117] Among them, Q adaptive is the process noise covariance matrix, which is affected by temperature changes; R adaptive is the measurement noise covariance matrix, which is affected by the signal-to-noise ratio; k1 and k2 are adjustment coefficients; Q0 is the initial value of the process noise covariance matrix; R0 is the initial value of the measurement noise covariance matrix;
[0118] Step 4-3: Use reinforcement learning optimization method to establish reward function Reward:
[0119] Reward=-||E true (t)-E LSTM (t)|| 2 ;
[0120] The LSTM weights and Kalman filter covariance matrix are dynamically adjusted through the reward function Reward to optimize the LSTM model and noise covariance matrix.
[0121] IMU signal-to-noise ratio (SNR) IMU It is the typical value of the signal-to-noise ratio of the IMU sensor, provided by the manufacturer.
[0122] In this embodiment, by dynamically adjusting the noise covariance matrix, the system can continuously optimize performance during real-time operation, and reinforcement learning dynamically adjusts the model parameters and the filter covariance matrix so that the model can adapt to the complex changes in the real-time environment. Through the multi-layer optimization mechanism (LSTM optimization + noise adjustment), error accumulation is further reduced, and the noise parameters can be automatically adjusted according to the real-time ambient temperature and IMU signal-to-noise ratio, thereby improving the robustness of the system.
[0123] Step 5: Use the prediction error to correct the inertial data and continuously optimize the model through a feedback mechanism to output high-precision navigation data.
[0124] When executing step 5, the IMU data P is calculated according to the following formula IMU (t) Make corrections to obtain the corrected navigation data P corrected (t):
[0125] P corrected (t) = P IMU (t)-E LSTM (t);
[0126] The corrected data is used to update the parameters of the LSTM model and the Kalman filter to continuously optimize the model through the feedback mechanism, and the navigation data P is output. corrected (t).
[0127] The following is an application scenario in this embodiment:
[0128] A drone was flying in a complex valley terrain. Due to terrain obstruction, the GNSS signal was intermittently lost, and the system needed to rely on inertial navigation equipment for high-precision positioning.
[0129] Input data:
[0130] IMU data: acceleration a(t) = [0.1, 0.2, -9.8] (m / s 2 ), angular velocity ω(t)=[0.01,-0.02,0.03].
[0131] GNSS positioning data:
[0132] P GNSS(t) = [39.123456, -76.543210, 100] (latitude, longitude and altitude, units: degrees and meters).
[0133] Ambient temperature:
[0134] T env (t) = 35°C.
[0135] Preprocessing:
[0136] Time interval error: E Δt =0.005×Δt,Δt=0.1s.
[0137] Fusion error calculation:
[0138] E IMU (t)=0.01+0.005×0.1=0.0105.
[0139] E T =0.002×(35-25)=0.02.
[0140] E 融合 (t)=0.0105+0.02+0.0005=0.031.
[0141] Error correction:
[0142] Corrected inertial data:
[0143] P corrected (t) = P IMU (t)-E LSTM (t),E LSTM (t) = 0.03.
[0144] Output: P corrected (t)=[39.123455,-76.543209,99.97].
[0145] The error prediction method of an inertial navigation device disclosed in the present invention solves the technical problem of improving the real-time performance and accuracy of a navigation system by directly embedding an IMU physical drift formula and an environmental error into an LSTM model, combining a dynamic adaptive mechanism and reinforcement learning optimization. The present invention integrates the IMU drift formula and the environmental temperature error modeling, enhances the prediction accuracy and gives the model a physical interpretation power, adjusts the noise covariance matrix according to the environmental temperature change and the IMU signal-to-noise ratio, improves the adaptability of the system to a dynamic environment, uses the real-time error as a reward signal, dynamically optimizes the LSTM weight and the covariance matrix, improves the prediction capability under long-term operation, performs feedback optimization on the corrected navigation data, and realizes model self-learning and performance iteration.
Claims
1. A method for error prediction of an inertial navigation device, characterized in that: The steps include: Step 1: The data acquisition module obtains IMU data P from the IMU sensor, GNSS receiver and environmental sensor respectively IMU (t), GNSS positioning data P GNSS (t) and ambient temperature data T env (t), and preprocessing; IMU data PIMU (t) includes acceleration a (t) and angular velocity ω (t); Preprocessing includes IMU data P IMU (t) Noise filtering is performed on the ambient temperature data T env (t) is smoothed and the IMU data P is aligned using the timestamp IMU (t) and GNSS positioning data P GNSS (t), and interpolate and extend the GNSS positioning data P GNSS (t) to IMU data P IMU (t) time frequency; time interval error E Δt Conduct mathematical modeling; The preprocessed data and time interval error E Δt Combine and obtain the feature vector X(t); Step 2: Data fusion module for IMU data P IMU (t) drift error E IMU (t) and the temperature error E of the ambient temperature data T Mathematical modeling is performed respectively according to the drift error E IMU (t), temperature error E T and time interval error E Δt , generate the initial fusion error E 融合 (t); the drift error E IMU (t) and temperature error E T Add to the feature vector X(t); Step 3: The LSTM calculation module retrieves the feature vector X(t) and the fusion error E 融合 (t), using the LSTM model and physical constraints to predict sensor errors, we get the error prediction result E LSTM (t); Step 4: Optimize the module to obtain real-time ambient temperature data T env (t), IMU signal-to-noise ratio SNR IMU And the error prediction result E LSTM (t) Establish a dynamic adaptive mechanism to adjust the noise covariance matrix according to environmental changes, use reinforcement learning optimization method to establish a reward function, dynamically adjust the LSTM weights and noise covariance matrix, obtain the optimized LSTM model weights and dynamically adjusted noise covariance matrix, and improve the real-time performance of error prediction and correction; Step 5: Use the prediction error to correct the inertial data and continuously optimize the model through a feedback mechanism to output high-precision navigation data.
2. The method for error prediction of an inertial navigation device according to claim 1, characterized in that: When executing step 1, the feature vector X(t) is expressed by the following formula: X(t)=[a(t),ω(t),P GNSS (t),T env (t),E Δt ]; Time interval error E Δt Calculated by the following formula: AND Δt =β×Δt; Among them, Δt is the time interval, which represents the IMU data P IMU (t) and GNSS positioning data P GNSS (t) is the time synchronization error at the same time; β is the time error influence coefficient, which represents the influence of the time delay between sensors.
3. The method for error prediction of an inertial navigation device as claimed in claim 2, characterized in that: When executing step 2, the specific steps are as follows: Step 2-1: IMU data P IMU (t) drift error E IMU (t) Modeling, as shown in the following formula: E IMU (t)=E IMU (t-1)+α×Δt; Among them, E IMU (t) is the IMU error at the current time point t, E IMU (t-1) is the IMU error at the previous time point t-1, α is the drift rate, and Δt is the time interval; Step 2-2: Temperature error E of ambient temperature data T Modeling, as shown in the following formula: E T =γ×(T env -T0); Among them, T env is the ambient temperature, T0 is the calibration temperature of the ambient sensor, γ is the temperature sensitivity coefficient; the ambient sensor is a temperature sensor; Step 2-3: Convert the drift error E IMU (t), temperature error E T and time interval error E Δt Fusion is performed to obtain the fusion error E 融合 (t): AND 融合 (t)=And IMU (t)+E T +E Δt ; Step 2-4: Convert the drift error E IMU (t) and temperature error E T After being added to the feature vector X(t), the feature vector X(t) is expressed as follows: X(t)=[a(t),ω(t),P GNSS (t),T env (t),E IMU (t),E T ,E Δt ]。 4. The method for error prediction of an inertial navigation device as claimed in claim 3, characterized in that: When executing step 3, the specific steps are as follows: Step 3-1: Feature input, specifically, taking the feature vector X(t) obtained in step 2-4 as the feature vector input into the input layer of the LSTM model; Step 3-2: Embed physical constraints in the LSTM model, specifically by transforming the drift error formula E IMU (t) = E IMU (t-1)+α×Δt and temperature error formula E T =γ×(T env -T0) is directly embedded in the input and gating mechanism of the LSTM model; Introduce drift rate α and time interval β in the forget gate; LSTM model fitting prediction result E LSTM1 (t); Step 3-3: Physical constraint regularization, specifically introducing the regularization term L phy Constrain the LSTM loss function: L phy =λ phy ×||E L (are you IMU (t)+E T +E Δt )|| 2 4 Among them, E L (t) is the error calculation of the intermediate process, which is used to constrain the degree of compliance of the LSTM model with physical laws; λ phy is the regularization coefficient, which adjusts the strength of the physical error constraint; Physical constraint regularization is used to encourage the prediction results E LSTM1 (t) satisfy physical constraints; Step 3-4: Combine the error loss and physical regularization loss to optimize the LSTM model weights and generate the final prediction result E LSTM (t), the total loss function L of LSTM is: THE total =L data +λL phy ; L data =||E true (t)-E LSTM1 (t)|| 2 ; Among them, λ is the weight factor, L data is the error loss based on the data.
5. The method for error prediction of an inertial navigation device as claimed in claim 4, characterized in that: When executing step 4, the specific steps include: Step 4-1: Get real-time ambient temperature data T env (t), IMU signal-to-noise ratio SNR IMU And the prediction result E LSTM (t); Step 4-2: Establish a dynamic adaptive mechanism to adjust the noise covariance matrix according to environmental changes: Q adaptive =Q0+k1×∣T env -T0∣; R adaptive =R0+k2×SNR IMU ; Among them, Q adaptive is the process noise covariance matrix, which is affected by temperature changes; R adaptive is the measurement noise covariance matrix, which is affected by the signal-to-noise ratio; k1 and k2 are adjustment coefficients; Q0 is the initial value of the process noise covariance matrix; R0 is the initial value of the measurement noise covariance matrix; Step 4-3: Use reinforcement learning optimization method to establish reward function Reward: Reward=-||E true (t)-E LSTM (t)|| 2 ; Among them, E true (t) is the true error; The LSTM weights and Kalman filter covariance matrix are dynamically adjusted through the reward function Reward to optimize the LSTM model and noise covariance matrix.
6. The method for error prediction of an inertial navigation device as claimed in claim 4, characterized in that: When executing step 5, the IMU data P is calculated according to the following formula IMU (t) Make corrections to obtain the corrected navigation data P corrected (t): P corrected (t)=P IMU (t)-E LSTM (t); The corrected data is used to update the parameters of the LSTM model and the Kalman filter to continuously optimize the model through the feedback mechanism, and the navigation data P is output. corrected (t).
Citation Information
Patent Citations
Adaptive filtering method of onboard inertia / satellite integrated navigation system and filter
CN103941273A
Intelligent autonomous navigation method under satellite denial
CN115824203A
Navigation error compensation method for micro-inertial satellite integrated navigation system
CN116380125A
A method and apparatus for determining the lane of a driving vehicle using an artificial neural network, and a navigation device including the same
KR102241116B1
Apparatus and method for predicting inertial navigation error
KR102715019B1
Cited By
Water-cooling central air conditioner load management and control method based on artificial intelligence
CN119934647A
An AI-based load control method for water-cooled central air conditioners
CN119934647B
Inertial sensor calibration method based on long and short term memory deep learning
CN120524804A
Air-drop and air-delivery large unmanned aerial vehicle ultra-low-altitude flight control system and method
CN121325930A
Self-adaptive evaluation method for health degree of electrolytic cell
CN121561291A