Method for restraining positioning error divergence of SINS / DVL integrated navigation system during USBL measurement failure

By analyzing the relationship between carrier speed and USBL measurement and introducing backpropagation neural network, the recursive error is predicted, and the problem of divergence of positioning errors in SINS/DVL combined navigation system when USBL measurement fails is solved, achieving higher positioning accuracy.

CN118913288AActive Publication Date: 2024-11-08HARBIN ENG UNIV

Patent Information

Application Number
CN202411108239.0
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-13
Publication Date
2024-11-08
Estimated Expiration
2044-08-13

AI Technical Summary

Technical Problem

Under normal working conditions of SINS and DVL, when USBL measurement fails, the positioning error of the SINS/DVL combined navigation system will gradually diverge, affecting the safe and efficient task execution of underwater vehicles.

Method used

By analyzing the relationship between carrier speed and USBL relative position measurement, recursively performing based on the initial USBL measurement results, and introducing a backpropagation neural network to train the navigation data online, using the trained model to predict the delivery during the USBL measurement failure period. To suppress the divergence of positioning errors.

Benefits of technology

It effectively suppresses the divergence of positioning errors in the combined navigation system during USBL measurement failure, improves positioning accuracy, and obtains higher positioning accuracy than the simple SINS/DVL combined navigation system.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118913288A_ABST
    Figure CN118913288A_ABST
Patent Text Reader

Abstract

The invention belongs to the technical field of integrated navigation, and researches on inhibition of positioning errors of an integrated navigation system under the condition of USBL measurement failure under the condition that an SINS and a DVL work normally. The purpose of the invention is realized through the following technical method, and the method comprises the following steps: analyzing the relation between the carrier system speed and USBL relative position measurement; carrying out recursion on a subsequent USBL measurement result based on carrier system velocity integration under the condition that an initial USBL relative position measurement result is given; the method comprises the following steps: introducing a back propagation (BP) neural network to carry out online training on navigation data; during USBL measurement failure, using the trained BP neural network model to predict recursion errors; and carrying out simulation verification and experimental verification on the provided method. In order to restrain divergence of positioning errors of an integrated navigation system during USBL measurement time limit, the invention provides a USBL measurement repair method based on a BP neural network by utilizing a relation between carrier system speed and a USBL measurement result, and the USBL measurement repair method is used for providing extra position reference information when the USBL fails.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the technical field of combined navigation. Under the condition that SINS and DVL work normally, the invention studies the suppression of positioning error of combined navigation system under the condition of USBL measurement failure. Background Art

[0002] DVL has the characteristics of high update frequency, good real-time performance and wide working range. SINS / DVL is one of the commonly used underwater navigation methods, but its positioning error will slowly diverge. USBL can provide position information and can obtain accurate positioning results when combined with SINS, but the working range of USBL is limited by the transponder, and the update frequency is low, and the navigation information is incoherent. Different navigation sensors have different advantages and disadvantages. Using the navigation information of SINS, DVL and USBL to build a SINS / DVL / USBL combined navigation system can complement each other and give full play to the advantages of various navigation sensors. The maintenance of positioning accuracy of the SINS / DVL / USBL combined navigation system mainly depends on the measurement information of USBL. When the underwater vehicle goes out of the working range of USBL or the acoustic signal is severely lost and interfered by the marine environment, USBL may have the problem of continuous long-term measurement failure. Although the SINS / DVL integrated navigation system can maintain the attitude and velocity accuracy of the navigation system for a long time only when the USBL measurement fails, the position error of the SINS / DVL integrated navigation system is unobservable, and the lack of USBL measurement information causes the positioning error of the navigation system to gradually diverge, which is not conducive to the safe and efficient execution of underwater vehicles. Therefore, it is necessary to study the suppression of the positioning error of the integrated navigation system under the condition of USBL measurement failure under the condition of normal operation of SINS and DVL. Summary of the invention

[0003] In view of the above-mentioned prior art, the technical problem to be solved by the present invention is to provide a method for suppressing the divergence of positioning errors of a SINS / DVL integrated navigation system when USBL measurement fails.

[0004] The purpose of the present invention is achieved by the following technical method, comprising the following steps:

[0005] Step 1: Analyze the relationship between the carrier system speed and the USBL relative position measurement;

[0006] Step 2: Given the initial USBL relative position measurement results, recursively extrapolate the subsequent USBL measurement results based on the carrier velocity integral;

[0007] Step 3: Introduce the back propagation (BP) neural network to perform online training on the navigation data;

[0008] Step 4: During the USBL measurement failure period, the recursive error is predicted using the trained BP neural network model;

[0009] Step 5: Conduct simulation and experimental verification of the proposed method.

[0010] Beneficial effects:

[0011] First, in order to suppress the divergence of the positioning error of the integrated navigation system during the USBL measurement period, a USBL measurement repair method based on BP neural network is proposed by utilizing the relationship between the carrier system velocity and the USBL measurement results to provide additional position reference information when the USBL fails.

[0012] Second, the proposed method effectively suppresses the divergence of positioning errors and can obtain higher positioning accuracy than the simple SINS / DVL combined navigation system. BRIEF DESCRIPTION OF THE DRAWINGS

[0013] Figure 1 To simulate trajectory and motion parameter changes;

[0014] Figure 2 To verify the attitude error curves of the two algorithms by simulation;

[0015] Figure 3 Position error curves of the two algorithms for simulation verification;

[0016] Figure 4 is the real USBL recursion error and the USBL recursion error predicted by the BP neural network;

[0017] Figure 5 For lake surface experiment trajectory;

[0018] Figure 6 To experimentally verify the posture error curves of the two algorithms;

[0019] Figure 7 The position error curves of the two algorithms are experimentally verified. DETAILED DESCRIPTION

[0020] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0021] In the description of the present invention, it should be understood that the terms "upper", "middle", "outer", "inner" and the like indicating directions or positional relationships are only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the components or elements referred to must have a specific direction, be constructed and operated in a specific direction, and therefore should not be understood as limiting the present invention.

[0022] Step 1: Analyze the relationship between the carrier system speed and the USBL relative position measurement;

[0023] The attitude matrix of the traditional error model of SINS is defined in the third-order special orthogonal group matrix space (SO(3)), while the velocity and position vectors are defined in the three-dimensional Euclidean space. The multiplication closure of the matrix space and the addition closure of the vector space result in the errors of each navigation parameter being defined in the same space. This means that the attitude error in the special orthogonal group matrix space is not considered when defining the velocity error and position error, which leads to inaccurate error definition. In order to solve this problem, Lie group theory has been introduced into the integrated navigation system in recent years.

[0024] By defining the rotational posture and the translational velocity and position in the same Lie group matrix space, the spatial inconsistency problem can be effectively improved and the performance of the navigation system can be enhanced.

[0025] Use posture, velocity, and position to construct elements of a special Euclidean group:

[0026]

[0027] Among them, χ is called the group state, and the real attitude matrix of SINS is The actual speed of SINS is The actual position of SINS is The special Euclidean group satisfies the relevant properties of the Lie group and is a type of Lie group. The relevant theories of the Lie group are fully applicable to it.

[0028] The Lie group state constructed by the navigation parameters solved by SINS is defined as

[0029]

[0030] Among them, the attitude matrix solved by SINS is The speed of SINS solution is The position solved by SINS is

[0031] Since there is a clear difference between left multiplication and right multiplication of a matrix, the error η of the Lie group state can be divided into two categories: left invariant Lie group error and right invariant Lie group error. Each type of Lie group error can be divided into two types.

[0032] Left Invariant Lie Group Error

[0033]

[0034] Right Invariant Lie Group Error

[0035]

[0036] The left invariant Lie group error is when the Lie group state χ and At the same time, the Lie group error remains unchanged after left multiplication with the same matrix; the right invariant Lie group error refers to the situation when the group state χ and At the same time, after right-multiplying by the same matrix, the Lie group error remains unchanged.

[0037] Previous studies have found that the SINS error model under the right invariant Lie group error definition is more suitable for constructing the mathematical model of the SINS / DVL and SINS / USBL integrated navigation system, and the tight combination has more advantages than the loose combination. Therefore, the present invention studies the SINS / DVL / USBL tight integrated navigation system under the right invariant Lie group error definition.

[0038] By the first right invariant Lie group error The definition can be obtained:

[0039]

[0040] Using the relationship between Lie groups and Lie algebras, we can get the error vector on the Lie algebra space as

[0041]

[0042] in, represents the misalignment angle vector, represents the velocity error vector on the Lie algebra space under the right invariant Lie group error definition, dp r represents the position error vector on the Lie algebra space under the right invariant Lie group error definition. for The modulus of , a is the unit rotation vector.

[0043] From (6), we can see that due to Therefore, the influence of the misalignment angle is also considered in the velocity error vector and position error vector of the right invariant Lie group error. The constructed navigation error is more accurate.

[0044] Assuming the misalignment angle is small, formula (6) can be simplified to

[0045]

[0046] DV r and dp rTaking the derivative of both sides at the same time, we get

[0047]

[0048] The velocity error differential equation under the definition of reference frame misalignment angle in the traditional SINS error model is:

[0049]

[0050] The differential equation of the attitude matrix and the reference frame misalignment angle in the traditional SINS error model are defined as (φ ee′ Substitute the velocity error differential equation into And ignoring the high-order small quantities, we get

[0051]

[0052] Substitute the differential equation of the attitude matrix and the differential equation of the position error in the traditional SINS error model into And ignoring the high-order small quantities, we get

[0053]

[0054] Formulas (10) and (11) are The velocity error differential equation and position error differential equation are defined below. Combining the inertial device error, the right invariant Lie group can be obtained Define the SINS error state equation.

[0055]

[0056] Among them, the state transfer matrix F r , the noise distribution matrix G r The specific form of the sum noise vector W is

[0057]

[0058] The velocity measurement model in the DVL beam direction is as follows:

[0059]

[0060] in, represents the installation deviation matrix, l is the lever arm between SINS and DVL, k dvl is the scale factor error of DVL. Represents the velocity vectors in the four beam directions measured by DVL, including measurement noise

[0061] The velocity solution of SINS is projected to the four beam directions of DVL and the difference between the velocity measured in the four beam directions of DVL is used as the measurement of the filter.

[0062]

[0063] in, represents the coordinate transformation matrix solved by SINS, Indicates the speed of SINS solution, Indicates the position solved by SINS.

[0064] According to the reference system misalignment angle φ ee′ , ignoring the high-order small quantities, and expanding the error terms of formula (17) to

[0065]

[0066] According to the definition of each error vector in the first right invariant Lie group error, the above formula can be written as

[0067]

[0068] Rearranging the above equation, we can obtain the measurement equation of the SINS / DVL tightly integrated navigation system under the definition of right invariant error:

[0069] z DVL紧 =H DVL紧,r dx r +υ DVL紧 (20)

[0070]

[0071] Among them, DVL紧 Represents the measurement noise.

[0072] For the SINS / DVL tightly integrated navigation system under the right invariant error definition, the depth information of the pressure sensor is also used to suppress the divergence of the celestial position error. The final SINS / DVL tightly integrated navigation system model under the right invariant error definition is:

[0073]

[0074] When the measurement information of DVL is updated but the measurement information of USBL is not updated, the SINS / DVL / USBL tightly integrated navigation system model is the same as formula (23).

[0075] When the measurement information of DVL is not updated, but the measurement information of USBL is updated, the SINS / DVL / USBL tightly integrated navigation system model is:

[0076]

[0077] When the measurement information of DVL and USBL are updated simultaneously, the SINS / DVL / USBL tightly integrated navigation system model is:

[0078]

[0079] After installation error matrix compensation, the relative position vector calculated by USBL is a physical quantity in the carrier coordinate system. The combination of SINS and DVL can output a relatively accurate carrier system velocity. Therefore, the relationship between the relative position vector measured by USBL and the carrier system velocity is:

[0080]

[0081] Wherein, s and t represent the data update time of two adjacent USBLs, t>s, and ts is the measurement update interval of USBL. and They represent the relative position vectors solved by USBL at time s and time t respectively. δp represents the carrier velocity calculated by SINS with the assistance of DVL. b It represents the error of the integral of the carrier system velocity, which is mainly caused by the carrier system velocity error. Represents the installation deviation matrix between SINS and USBL.

[0082] Step 2: Given the initial USBL relative position measurement results, recursively extrapolate the subsequent USBL measurement results based on the carrier velocity integral;

[0083] According to formula (26), the relative position vector measured by USBL at time t is can be rewritten as .

[0084]

[0085] Due to the error δp b is unknown, only the system speed at time s and time t is used And the measurement results of USBL at time s Recursively deduce the relative position vector of USBL measurement at time t There will be a large error. If δp b If prediction is made, formula (27) can be used to accurately recursively extrapolate the USBL measurement results during the USBL measurement failure period, thereby suppressing the divergence of the positioning error of the integrated navigation system.

[0086] Step 3: Introduce the back propagation (BP) neural network to perform online training on the navigation data;

[0087] Since δp bIt is mainly affected by the velocity error of the carrier system and the angular motion of the carrier, and there are regularities to follow. Therefore, it is considered to use a neural network to calculate the δp at different times during the navigation process. b Fitting is performed to determine the δp during USBL failure. b Prediction is performed to improve the accuracy of the calculation of formula (27). BP neural network is a multi-layer feedforward artificial neural network with error correction backpropagation. It has strong nonlinear mapping ability for input and output information and good generalization ability. BP neural network is particularly suitable for fitting and function approximation tasks, and its structure is simple and the calculation amount is small. It is widely used in various data prediction problems. Therefore, it is considered to build a BP neural network model during the normal operation of USBL, and use the sensor measurement data to train the BP neural network model so that it has the ability to predict δp b During the USBL measurement failure period, the trained BP neural network model was used to predict δp b The prediction is performed, and the relative position information measured by USBL is recursively calculated using formula (27) to suppress the divergence rate of the positioning error of the integrated navigation system.

[0088] The BP neural network model training is completed under the condition that SINS, DVL and USBL are all working normally. In this case, the SINS / DVL / USBL combined navigation algorithm and the SINS / DVL combined navigation algorithm are run in parallel, and the two do not interfere with each other. The normal navigation output uses the result of the SINS / DVL / USBL combined navigation algorithm. The SINS / DVL combined navigation algorithm is run to simulate the navigation system output under the condition of USBL measurement failure to train the BP neural network model.

[0089] Since δp b The size of is mainly related to the carrier system speed and the carrier angular motion. Therefore, the training input of the BP neural network model is the integral of the carrier system speed between two adjacent USBL update times. Carrier coordinate system transformation matrix The corresponding Euler angle θ and the training output δp at the last USBL update time b Among them, the carrier system speed Adopt the output of SINS / DVL integrated navigation algorithm.

[0090] For the training output δp of the BP neural network model b , calculated using the following formula

[0091]

[0092] In the formula, and Represents the carrier system velocity and carrier coordinate system transformation matrix output by the SINS / DVL integrated navigation system. represents the projection of the relative position vector of the USBL acoustic array relative to the transponder calculated by the output of the SINS / DVL / USBL integrated navigation system in the carrier coordinate system. The reason for not directly using the USBL measurement output to calculate formula (28) is that the output of the integrated navigation system using a robust filter is smoother and more stable, which is more conducive to ensuring the calculation accuracy of the training output.

[0093] It is expressed as follows

[0094]

[0095] In the formula, Indicates the location of the transponder, and represents the attitude matrix and position vector output by the SINS / DVL / USBL integrated navigation system, l usbl Represents the lever arm of SINS and USBL.

[0096] The entire BP neural network model training process is as follows:

[0097] (1) Initialize the BP neural network model parameters and set the number of training set samples N.

[0098] (2) Run the SINS / DVL / USBL integrated navigation algorithm and the SINS / DVL integrated navigation algorithm in parallel. When the USBL measurement data is updated, the output of the SINS / DVL integrated navigation algorithm is used to calculate the carrier system velocity integral from the most recent USBL measurement update time to the current time. Carrier coordinate system transformation matrix The corresponding Euler angle θ(t) and the training output δp at the last USBL update time b (tT usbl ) Construct training set input samples T usbl is the USBL measurement update period. Using formula (28) and formula (29) to construct the training set output sample Y(t) = δp b (t).

[0099] (3) If the training set is not full, add the input and output samples in step (2) to the training set. If the training set is full, delete the earliest sample in the training set and add the input and output samples in step (2) to the training set.

[0100] (4) When USBL measurement fails, the BP neural network model is trained using the existing training set.

[0101] Step 4: During the USBL measurement failure period, the recursive error is predicted using the trained BP neural network model;

[0102] Assume that the USBL measurement data is updated normally at time t, and USBL measurement fails after time t. Set the time interval T u , every T u The relative position vector measurement results of USBL are recursively extrapolated over time.

[0103] First, the output of the SINS / DVL integrated navigation system is used to calculate the time from time t to t+T u The integral of the projection of the velocity of the load system at time t on the carrier coordinate system Carrier coordinate system transformation matrix The corresponding Euler angle θ(t+T u ).

[0104] Secondly, θ(t+T u ) and the recursive error prediction value at time t As input, BP neural network is used to predict the recursive error Based on formula (27), we get t+T u Recursive results of USBL relative position measurement at time

[0105]

[0106] Finally, the SINS / USBL loose integrated navigation system is constructed using the above USBL measurement recursion results to suppress the divergence of SINS / DVL integrated navigation positioning errors.

[0107] Every subsequent T u The last process is repeated based on the last USBL recursive result until the USBL measurement result is updated normally. In addition, considering that the error of the USBL recursive result will gradually increase with the increase of time, the maximum continuous working time of the positioning error suppression method should be set in actual use. When the USBL measurement failure time is greater than T max When the USBL result is used, the recursive prediction is no longer performed to prevent the negative impact on the positioning accuracy of the SINS / DVL integrated navigation system.

[0108] Step 5: Conduct simulation and experimental verification of the proposed method.

[0109] To verify the effectiveness of the proposed method, the following two algorithms are compared:

[0110] Algorithm 1: Perform SINS / DVL / USBL combined navigation when USBL is not invalid, and perform SINS / DVL combined navigation when USBL is invalid.

[0111] Algorithm 2: When USBL is not invalid, SINS / DVL / USBL combined navigation is performed. When USBL fails, the positioning error suppression method introduced is used for navigation solution.

[0112] Simulation verification:

[0113] The Multiple Adaptive Statistical Similarity Measure Kalman Filter (MASSMKF) based on covariance decomposition and statistical similarity measure is used as the filter of the integrated navigation system. The measurement noise of the four beam directions of DVL is randomly generated from the following distributions:

[0114]

[0115] Formula (31) indicates that there is a 90% probability that according to the normal distribution N(0,(0.1m / s) 2 ) generates measurement noise, with a 10% probability according to a normal distribution with a larger variance N(0,(2m / s) 2 ) generates measurement noise.

[0116] The azimuth and slant range measurement noises of USBL are randomly generated from the following distributions:

[0117]

[0118] The meaning of formula (32) is similar to that of formula (31). The numerical simulation sensor parameters are shown in Table 1:

[0119] Table 1 Simulation parameter settings

[0120]

[0121]

[0122] The USBL measurement noise is set to zero-mean Gaussian noise, and the filter parameters are set according to the sensor measurement accuracy. The simulation trajectory is as follows Figure 1 shown.

[0123] The initial horizontal attitude error was randomly selected in the interval [0°, 10°], and the initial heading error was randomly selected in the interval [0°, 120°]. 50 Monte Carlo simulations were performed, and the error mean and root mean square error were statistically calculated.

[0124] Before 10000s, the SINS, DVL and USBL measurement results were updated normally, except for occasional measurement outliers. After 10000s, the USBL measurement was set to be invalid.

[0125] The number of training set samples is set to 200, the RBF middle layer is set to 5 layers, and the time interval is T u Set it to 10s, and get the simulation results as follows.

[0126] Figure 2 It shows the attitude error curves of the two algorithms. It can be seen from the figure that since the navigation system is always in the combined navigation mode, the attitude errors of the two algorithms can converge accurately, and the attitude error curves of the two algorithms are very similar during the USBL failure period after 10000s. Table 2 statistics the attitude error RMS of the two algorithms after 10000s. It can be seen from the table that the difference in the attitude error RMS of algorithm 1 and algorithm 2 is within 0.0001 degrees. The proposed positioning error suppression method does not have an adverse effect on the attitude accuracy.

[0127] Figure 3 are the position error curves of the two algorithms. As can be seen from the figure, when USBL fails, the positioning error of Algorithm 1 increases significantly. Although the positioning error of Algorithm 2 also increases, it is also significantly smaller than the positioning error of Algorithm 1. Table 3 statistics the RMS of the position errors of Algorithm 1 and Algorithm 2 after 10,000 seconds. It can be seen from the table that the horizontal position error RMS of Algorithm 2 is 6.3954m, which is 43.03% smaller than the horizontal position error RMS of Algorithm 1. Therefore, Algorithm 2 can effectively suppress the growth of positioning error during USBL failure.

[0128] Figure 4 The actual USBL recursion error and the USBL recursion error predicted by the BP neural network are statistically analyzed. It can be seen from the figure that the recursion error predicted by the BP neural network and the actual recursion error have similar change trends, and the values ​​are relatively close. This is the reason why Algorithm 2 can achieve better positioning accuracy.

[0129] The simulation results show that the proposed method can ensure that the navigation system has a higher positioning accuracy than the SINS / DVL combined navigation during a longer period of USBL failure, and effectively suppress the divergence of positioning errors.

[0130] Table 2 Attitude error RMS after 10000s

[0131]

[0132] Table 3 Position error RMS after 10000s

[0133]

[0134] Experimental verification:

[0135] The lake test data is used to verify the proposed positioning error suppression algorithm. The experimental trajectory is as follows Figure 5 shown.

[0136] The main experimental equipment is fiber-optic SINS, French fiber-optic strapdown inertial navigation system (PHINS), DVL, USBL and GPS. The PHINS and GPS combined system (PHINS / GPS) is used as a navigation benchmark to evaluate the accuracy of the SINS and USBL tightly integrated navigation system.

[0137] Table 4 Lake surface experimental equipment parameters

[0138]

[0139] Due to the good experimental environment on the lake, the acoustic sensor rarely has measurement outliers. In order to verify the effectiveness of the proposed robust filter, additional measurement outliers are added to the DVL and USBL measurement data with a probability of 10%. Among them, the four beam measurement outliers of DVL are distributed from Gaussian distribution N(0,(1m / s) 2 ), the USBL azimuth measurement wild value is randomly generated from the Gaussian distribution N(0,(2°) 2 ), the USBL slant range measurement wild value is randomly generated from the Gaussian distribution N(0,(200m) 2 ) are randomly generated in the kernel, and the generation of different measured wild values ​​is independent of each other.

[0140] MASSMKF is used as the filter of the integrated navigation system, and the navigation data from 1000s to 1600s is used to train the BP neural network. The USBL measurement interruption is set after 1600s. The results of Algorithm 1 and Algorithm 2 are as follows.

[0141] Figure 6 Figure 2 is the posture error curve of Algorithm 1 and Algorithm 2. Similar to the simulation results, even in the actual environment, Algorithm 1 and Algorithm 2 have almost the same posture accuracy. Figure 7 The position error curves of Algorithm 1 and Algorithm 2 also show that Algorithm 2 can more effectively suppress the divergence of the position error. Table 6 statistics the RMS of the position error of Algorithm 1 and Algorithm 2 after 1600s. From the results in the table, it can be seen that the RMS of the horizontal position error of Algorithm 2 is 30.17% smaller than that of Algorithm 1, and the divergence of the positioning error is obviously suppressed.

[0142] Comprehensive simulation and experimental results show that the proposed positioning error suppression strategy under USBL failure is effective and can ensure the positioning accuracy of the navigation system during a long period of USBL interruption.

[0143] Table 6 Position error RMS after 1600s

[0144]

[0145] In the description of this specification, the description with reference to the terms "one embodiment", "example", "specific example", etc. means that the specific features, structures, materials or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the present invention. In this specification, the schematic representation of the above terms does not necessarily refer to the same embodiment or example. Moreover, the specific features, structures, materials or characteristics described can be combined in any one or more embodiments or examples in a suitable manner.

[0146] The preferred embodiments of the present invention disclosed above are only used to help illustrate the present invention. The preferred embodiments do not describe all the details in detail, nor do they limit the invention to the specific implementation methods described. Obviously, many modifications and changes can be made according to the content of this specification. This specification selects and specifically describes these embodiments in order to better explain the principles and practical applications of the present invention, so that those skilled in the art can understand and use the present invention well. The present invention is limited only by the claims and their full scope and equivalents.

Claims

1. A method for suppressing the divergence of positioning errors of a SINS / DVL integrated navigation system when USBL measurement fails, characterized in that: The steps include: Step 1: Analyze the relationship between the carrier system speed and the USBL relative position measurement; Step 2: Given the initial USBL relative position measurement results, recursively extrapolate the subsequent USBL measurement results based on the carrier velocity integral; Step 3: Introduce the back propagation (BP) neural network to perform online training on the navigation data; Step 4: During the USBL measurement failure period, the recursive error is predicted using the trained BP neural network model; Step 5: Conduct simulation and experimental verification of the proposed method.

Citation Information

Patent Citations

  • SINS / USBL loose integration navigation positioning method introducing radial speed

    CN111380520A

  • Navigation method for underwater vehicle

    CN115127549A

  • SINS / USBL integrated navigation method based on earth coordinate system and right group state error definition

    CN115307631A

  • Fault location and recovery method for underwater SINS / DVL / PS tightly integrated navigation system

    CN116147617A

  • Underwater tight integration navigation method of SINS / DVL / USBL based on centralized filtering

    CN116539032A

Cited By

  • SINS / DVL integrated navigation backtracking type initial alignment method and device based on Lie group SE3 (3)

    CN121977546A