Underwater AUV coarse alignment method based on acoustic position giving

By acquiring the position information of the slave AUV from the master AUV and combining it with SINS and DVL data for integration and compensation, the problem of coarse alignment accuracy and complexity of underwater AUVs is solved, realizing a high-precision, low-complexity underwater alignment method.

CN118913312APending Publication Date: 2024-11-08HARBIN ENG UNIV
View PDF 0 Cites 2 Cited by

Patent Information

Application Number
CN202410983879.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-22
Publication Date
2024-11-08

AI Technical Summary

Technical Problem

Existing coarse alignment methods for underwater AUVs suffer from problems such as GPS unavailability and inconsistent sampling frequencies between SINS and DVL in underwater environments, resulting in limited improvement in alignment accuracy and increased algorithm complexity.

Method used

The position information of the AUV is obtained by the main AUV through ultra-short baseline measurement. The SINS accelerometer and DVL velocity information are integrated and compensated. The data segment with the minimum interference acceleration is selected by combining the sliding window. The reference and observation vectors are constructed and the attitude transformation matrix is ​​orthogonalized to achieve underwater coarse alignment of the AUV.

Benefits of technology

It improves alignment accuracy, reduces algorithm complexity, and enhances the applicability of the method, especially in situations where GPS location cannot be obtained underwater, it can still achieve high-precision alignment.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118913312A_ABST
    Figure CN118913312A_ABST
Patent Text Reader

Abstract

The invention discloses an underwater AUV (Autonomous Underwater Vehicle) coarse alignment method based on acoustic position giving, and belongs to the technical field of coarse alignment of inertial navigation systems. The invention aims to improve the alignment precision and applicability of the existing method and reduce the complexity of the existing method. The master AUV measures the position of the slave AUV by means of the ultra-short base lines installed on the master AUV and the slave AUV and sends the position of the slave AUV to the slave AUV in an underwater acoustic communication mode, and the slave AUV determines the position of the slave AUV according to the received position information and by fully utilizing SINS accelerometer data. A data segment corresponding to a window with the minimum average resultant interference acceleration is selected as an integral interval for constructing a vector through a sliding window, and the accelerometer output of the SINS is compensated by using speed information provided by a DVL installed on the slave AUV, so that the underwater coarse alignment of the slave AUV in master-slave collaborative navigation is realized; and the alignment error caused by linear motion generated by the AUV under the influence of ocean current is reduced. The method can be applied to coarse alignment of the underwater AUV in an inertial navigation system.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the technical field of coarse alignment of an inertial navigation system, and in particular relates to a coarse alignment method of an underwater AUV based on acoustic positioning. Background Art

[0002] In the collaborative navigation of master and slave AUVs, initial alignment is the process of providing initial attitude information to the strapdown inertial navigation system (SINS) installed on the slave AUV. The accuracy of initial alignment affects the performance of the subsequent collaborative navigation of the slave AUV system. Initial alignment usually includes two stages: coarse alignment and fine alignment. Coarse alignment is the first step of the entire alignment process, providing a rough initial attitude for fine alignment. Therefore, the accuracy of coarse alignment directly determines the positioning accuracy of the navigation system. The coarse alignment method based on dual-vector attitude matrix decomposition (DV-ADIA) uses the integral of the gravity acceleration vector and the integral of the accelerometer output of SINS to establish the reference vector and the observation vector, and estimates the attitude transformation matrix between the carrier coordinate system and the navigation coordinate system based on the mathematical principle of determining the orientation transformation relationship between the two coordinate systems by dual vectors. However, when aligning from the AUV in water, it is impossible to remain completely stationary. The linear motion of the AUV will cause interference acceleration in the accelerometer output of the inertial navigation system, resulting in errors in the observation vector, which in turn affects the coarse alignment accuracy.

[0003] The patent application with publication number CN112945274A, "A rough alignment method for ship strapdown inertial navigation system during navigation", proposed a rough alignment method based on GPS position assistance, which obtains various parameters by double integral method, reduces periodic oscillation error, and improves the rough alignment accuracy. The patent application with publication number CN111854747A, "A DVL-assisted SINS rough alignment method under large carrier maneuvers", uses SINS output information to model and compensate for the Doppler velocity log (DVL) velocity measurement error, reduces the rough alignment time, and improves the rough alignment accuracy. Ben Yueyang et al. proposed "A rough alignment method for ship strapdown inertial navigation system during navigation under satellite guidance", which uses the position information obtained by GPS to achieve rough alignment. Han Yongqiang et al. proposed "A QUEST optimized rough alignment algorithm for vehicle-mounted strapdown inertial navigation during navigation", which uses the QUEST algorithm with gravity vector modulus error as weight reference to reduce the error impact and improve the rough alignment accuracy. The paper (In-Motion Filter-QUEST Alignment for Strapdown Inertial Navigation Systems) reconstructs the observation vector by real-time wavelet denoising and adaptive Kalman filtering, removes the sensor high-frequency noise and interference acceleration, and improves the coarse alignment accuracy. The paper (In-motion coarse alignment method for SINS / DVL with the attitude dynamics) introduces a Doppler odometer as external reference information and proposes a DVL velocity compensation algorithm, which reduces the DVL measurement error in attitude dynamics and shortens the alignment time.

[0004] Although the existing methods have achieved certain results, they have increased the complexity of the algorithm. Moreover, in underwater environments where there are problems such as GPS unavailability and inconsistent sampling frequencies of SINS and DVL, the application of the existing methods still has certain limitations, and the effect of improving the alignment accuracy is still limited. Summary of the invention

[0005] The purpose of the present invention is to improve the alignment accuracy and applicability of the existing method and reduce the complexity of the existing method, and propose an underwater AUV rough alignment method based on acoustic positioning.

[0006] The technical solution adopted by the present invention to solve the above technical problems is: a method for coarse alignment of underwater AUV based on acoustic positioning, the method specifically comprising the following steps:

[0007] Step 1: The slave AUV receives the position information of the slave AUV obtained by ultra-short baseline measurement of the master AUV at the start time of alignment through underwater acoustic communication;

[0008] Step 2: Collect t from AUV k The acceleration information output by the SINS accelerometer, the angular velocity information output by the SINS gyroscope, and the velocity information output by the DVL at the moment;

[0009] The acceleration information output by the SINS accelerometer is expressed as: in, and Respectively represent t k The components of the specific force measured by the SINS accelerometer on the three axes of the carrier coordinate system at the moment, in m / s 2 ;

[0010] The angular velocity information output by the SINS gyroscope is expressed as: in and Respectively represent t k The components of the angular velocity measured by the SINS gyroscope on the three axes of the carrier coordinate system at the moment, in rad / s;

[0011] The speed information output by DVL is expressed as: in, and Respectively represent t k The rightward speed, forward speed and upward speed of the slave AUV in the carrier coordinate system measured by DVL at the moment, in m / s;

[0012] Step 3: Update t according to the latitude and longitude information provided by the master AUV k Attitude transformation matrix from inertial coordinate system to navigation coordinate system at the moment

[0013] Step 4: Update t according to the angular velocity information output by the SINS gyroscope k The carrier coordinate system at the moment to the carrier inertial coordinate system at the initial moment i b0 The attitude transformation matrix

[0014] Step 5: Based on the acceleration information output by the SINS accelerometer and Get t k The projection of the gravitational acceleration at the initial moment on the carrier's inertial coordinate system According to the local gravity acceleration information and attitude transformation matrix Get t k The projection of the gravitational acceleration in the geocentric inertial coordinate system at the moment g i (t k );

[0015] Step 6: Determine whether the alignment is completed;

[0016] If the alignment is completed, proceed to step seven;

[0017] If the alignment is not completed, set k=k+1 and return to step 2;

[0018] Step 7: Select the first integration interval according to the accelerometer data obtained at each sampling time and the set sliding time window;

[0019] Step 8: g i (t k ) Integrate the first integration interval and the second integration interval selected in step 7 respectively to construct a reference vector; In step 7, the first integration interval and the second integration interval selected are integrated to construct the observation vector; the second integration interval is from the alignment start time t0 to the alignment end time t M The data segment;

[0020] And calculate the attitude transformation matrix from the geocentric inertial coordinate system to the carrier inertial coordinate system at the initial moment based on the observation vector and the reference vector

[0021] Step 9: Using the Posture Transformation Matrix and To make a preliminary estimate of t k Attitude transformation matrix from the carrier coordinate system to the navigation coordinate system at the moment Then the initial estimated matrix Perform orthogonal processing to obtain the posture transformation matrix after orthogonal processing

[0022] Step 10: Use t k Moment-by-moment attitude transformation matrix And DVL output speed information To compensate for k Accelerometer output at all times to get compensation results And according to right Update to get

[0023] Step 11: Utilization Return to step 8 and recalculate And according to Finally, it is estimated that t k The attitude transformation matrix from the carrier coordinate system to the navigation coordinate system at the moment Then the final estimated posture transformation matrix Perform orthogonal processing to obtain the posture transformation matrix after orthogonal processing

[0024] Step 12: Transform the matrix according to the posture Solve t k Estimation results of the three attitude angles of the AUV at the moment;

[0025]

[0026] Among them, C ij , i,j=1,2,3 represents the attitude transformation matrix The elements in the i-th row and j-th column in , θ, γ, and ψ represent the estimated pitch angle, roll angle, and heading angle, respectively.

[0027] Furthermore, the specific process of step three is:

[0028] Transform the pose matrix Decomposed into the form of two matrix multiplications, namely represents the attitude transformation matrix from the earth coordinate system to the navigation coordinate system, Represents the attitude transformation matrix from the geocentric inertial coordinate system to the earth coordinate system;

[0029]

[0030] Where L0 and λ0 represent the start time of the main AUV acoustic measurement alignment from the AUV longitude and latitude, respectively, in degrees, t0 represents the start time of the rough alignment, ω ie represents the angular velocity of the Earth's rotation, T S is the SINS sampling period.

[0031] Furthermore, the specific process of step 4 is as follows:

[0032]

[0033] Among them, I 3×3 is the 3×3 identity matrix, It is the attitude transformation matrix from the carrier coordinate system to the carrier inertial coordinate system at the initial moment of alignment. is at k At the moment, the attitude conversion matrix from the carrier coordinate system to the carrier inertial coordinate system at the initial moment, is at k-1 At the moment, the attitude conversion matrix from the carrier coordinate system to the carrier inertial coordinate system at the initial moment, They represent the components of the angular velocity information output by the SINS gyroscope on the three axes of the carrier coordinate system, φ k × Represents φ k The antisymmetric matrix is ​​formed, and “|*|” represents the modulo operation.

[0034] Furthermore, the antisymmetric matrix φ k × for:

[0035]

[0036] Furthermore, in step 5, t k The projection of the gravitational acceleration in the geocentric inertial coordinate system at the moment g i (t k )for:

[0037]

[0038] in, For the matrix The transposed matrix, g n Represents the projection of gravity acceleration in the navigation coordinate system, g n =[00-g] T , g represents the acceleration due to gravity, g = g0 (1 + 0.0053024sin 2 L0-0.0000058sin 2 2L0), g0 is the Earth's gravitational constant;

[0039] The k The projection of the gravitational acceleration at the initial moment on the carrier's inertial coordinate system for:

[0040]

[0041] Furthermore, the specific process of step seven is as follows:

[0042] The accelerometer data obtained at each sampling moment is processed using a sliding time window:

[0043]

[0044] Among them, f b (t j ) indicates t j The acceleration information output by the SINS accelerometer at time t, w represents the length of the sliding time window;

[0045] Select the smallest s k , the smallest s k Denoted as s a , will s a The corresponding sampling time period [t a ,t a+w-1 ] as the first integration interval selected.

[0046] Furthermore, the specific process of step eight is as follows:

[0047] Step 81: Create a reference vector and

[0048]

[0049] Points:

[0050]

[0051] Step 82: Establish observation vector and

[0052]

[0053] Step 83: Calculate the attitude transformation matrix based on the observation vector and the reference vector

[0054]

[0055] Among them, the superscript -1 represents inversion, and the superscript T represents transposition.

[0056] Furthermore, the t k The attitude conversion matrix from the carrier coordinate system to the navigation coordinate system at this moment is:

[0057]

[0058] in, is the initial estimated attitude transformation matrix, yes The transposed matrix of .

[0059] Furthermore, the specific process of step ten is as follows:

[0060]

[0061] in, represents the compensated accelerometer output; Represents the attitude transformation matrix The transpose of Indicates t k The projection of the AUV velocity output by DVL in the carrier coordinate system at the moment; yes The antisymmetric matrix of h0 represents the initial height of the AUV, R N is the principal curvature radius of the y-axis circle, R M is the principal radius of curvature of the meridian, in m;

[0062] but for:

[0063]

[0064] Furthermore, the specific process of step 11 is as follows:

[0065]

[0066] in, and is the updated observation vector;

[0067]

[0068] in, is the updated attitude transformation matrix from the geocentric inertial coordinate system to the carrier inertial coordinate system at the initial moment;

[0069]

[0070] in, It is the final estimated attitude transformation matrix from the carrier coordinate system to the navigation coordinate system;

[0071] Then the posture transformation matrix Perform orthogonal processing to obtain the posture transformation matrix after orthogonal processing

[0072] The beneficial effects of the present invention are:

[0073] The master AUV of the present invention measures the position of the slave AUV by means of an ultra-short baseline installed on the master and slave AUVs, and sends the position of the slave AUV to the slave AUV in the form of hydroacoustic communication. The slave AUV constructs a corresponding vector based on the position information and the installed SINS system to complete the rough alignment. The present invention makes full use of the SINS accelerometer data, selects the data segment corresponding to the window with the smallest average combined interference acceleration as the integral interval for constructing the vector through a sliding window, and also uses the speed information provided by the DVL installed on the slave AUV to compensate for the accelerometer output of the SINS, thereby realizing the rough alignment of the slave AUV in the water in the master-slave collaborative navigation, reducing the alignment error caused by the linear motion of the slave AUV under the influence of the ocean current, making full use of the original SINS data, and introducing the speed information provided by the DVL for compensation, thereby improving the alignment accuracy. In the case where the GPS position cannot be obtained underwater, the position information provided by the USBL is used to realize the rough alignment of the slave AUV underwater, thereby enhancing the applicability of the alignment method.

[0074] At the same time, compared with the existing methods, the complexity of the alignment method is reduced. BRIEF DESCRIPTION OF THE DRAWINGS

[0075] Figure 1A flowchart of a rough alignment method of an inertial navigation system based on acoustic positioning according to the present invention;

[0076] Figure 2 It is a comparison diagram of the average combined disturbance acceleration in the integral interval selected for the sliding window;

[0077] Figure 3 This is a comparison chart of the dead reckoning path trajectory;

[0078] Figure 4 This is a comparison chart of dead reckoning positioning errors. DETAILED DESCRIPTION

[0079] Specific implementation method 1: Combination Figure 1 The present embodiment describes an underwater AUV rough alignment method based on acoustic positioning, and the method specifically comprises the following steps:

[0080] Step 1: The slave AUV receives the position information of the slave AUV obtained by ultra-short baseline measurement of the master AUV at the start time of alignment through underwater acoustic communication;

[0081] The step 1 is implemented based on acoustic positioning, that is, the position information of the slave AUV is measured by using the ultra-short baseline acoustics of the master AUV, and the position information of the slave AUV measured by the master AUV is sent to the slave AUV by means of underwater acoustic communication;

[0082] Step 2: Collect t from AUV k The acceleration information output by the SINS accelerometer, the angular velocity information output by the SINS gyroscope, and the velocity information output by the DVL at the moment;

[0083] The acceleration information output by the SINS accelerometer is expressed as: in, and Respectively represent t k The components of the specific force measured by the SINS accelerometer on the three axes of the carrier coordinate system at the moment, in m / s 2 ;

[0084] The angular velocity information output by the SINS gyroscope is expressed as: in and Respectively represent t k The components of the angular velocity measured by the SINS gyroscope on the three axes of the carrier coordinate system at the moment, in rad / s;

[0085] The speed information output by DVL is expressed as: in, and Respectively represent t kThe rightward speed, forward speed and upward speed of the slave AUV in the carrier coordinate system measured by DVL at the moment, in m / s;

[0086] Step 3: Update t according to the latitude and longitude information provided by the master AUV k Attitude transformation matrix from inertial coordinate system to navigation coordinate system at the moment

[0087] Step 4: Update t according to the angular velocity information output by the SINS gyroscope k The carrier coordinate system at the moment to the carrier inertial coordinate system at the initial moment i b0 The attitude transformation matrix

[0088] Step 5: Based on the acceleration information output by the SINS accelerometer and Get t k The projection of the gravitational acceleration at the initial moment on the carrier's inertial coordinate system According to the local gravity acceleration information and attitude transformation matrix Get t k The projection of the gravitational acceleration in the geocentric inertial coordinate system at the moment g i (t k );

[0089] Step 6: Determine whether the alignment is completed;

[0090] If the alignment is completed, proceed to step seven;

[0091] If the alignment is not completed, set k=k+1 and return to step 2;

[0092] Step 7: Select the first integration interval according to the accelerometer data obtained at each sampling time and the set sliding time window;

[0093] Step 8: g i (t k ) Integrate the first integration interval and the second integration interval selected in step 7 respectively to construct a reference vector; In step 7, the first integration interval and the second integration interval selected are integrated to construct the observation vector; the second integration interval is from the alignment start time t0 to the alignment end time t M The data segment;

[0094] And calculate the constant attitude transformation matrix from the geocentric inertial coordinate system to the carrier inertial coordinate system at the initial moment based on the observation vector and the reference vector

[0095] Step 9: Using the Posture Transformation Matrix and To make a preliminary estimate of tk Attitude transformation matrix from the carrier coordinate system to the navigation coordinate system at the moment Then the initial estimated matrix Perform orthogonal processing to obtain the posture transformation matrix after orthogonal processing

[0096] Step 10: Use t k Moment-by-moment attitude transformation matrix And DVL output speed information To compensate for k Accelerometer output at all times to get compensation results And according to right Update to get

[0097] Step 11: Utilization Return to step 8 and recalculate And according to Finally, it is estimated that t k The attitude transformation matrix from the carrier coordinate system to the navigation coordinate system at the moment Then the final estimated posture transformation matrix Perform orthogonal processing to obtain the posture transformation matrix after orthogonal processing

[0098] Step 12: Transform the matrix according to the posture Solve t k Estimation results of the three attitude angles of the AUV at the moment;

[0099]

[0100] Among them, C ij , i,j=1,2,3 represents the attitude transformation matrix The elements in the i-th row and j-th column in , θ, γ, and ψ represent the estimated pitch angle, roll angle, and heading angle, respectively.

[0101] (1) The coordinate system of the present invention is selected as follows:

[0102] a) Geocentric inertial coordinate system (i system): The origin is the center of the earth, i x i and i y i The axis is in the equatorial plane, where o i x i The axis points to the vernal equinox, o i z i The axis is the earth's rotation axis and points to the North Pole. The i system does not move with the earth's rotation.

[0103] b) Earth coordinate system (e system): The origin is the center of the earth, o e x e and e y e The axis is in the Earth's equatorial plane, where o e x e Point to the prime meridian, o e z e The axis is the Earth's rotation axis and points to the North Pole, and the e system is fixed to the Earth.

[0104] c) Navigation coordinate system (n system): Define the "east-north-sky" coordinate system as the navigation coordinate system. The origin is the center of the carrier, o n x n Pointing to geographic east, o n y n Points to geographic north, o n z n Pointing toward the sky.

[0105] d) Carrier coordinate system (b system): define the "right-front-up" coordinate system as the carrier coordinate system. The origin is the center of the carrier, o b x b Pointing to the right of the carrier horizontal axis, o b y b Pointing forward along the longitudinal axis of the carrier, o b z b Pointing upwards to the geographic axis, system B is fixedly connected to the carrier.

[0106] e) Initial moment carrier inertial coordinate system (i b0 system): coincides with system b at the start of initial alignment, and i b0 System a does not rotate with system b, that is, it keeps its direction unchanged in inertial space.

[0107] (2) Set geographic information parameters: Earth's rotation angular velocity ω ie , the radius of the Earth's major axis R, the Earth's gravitational constant g0, and the Earth's eccentricity e.

[0108] (3) Set the initial position of the slave AUV: The initial position of the slave AUV p0 = [L0 λ0 h0] obtained by receiving the ultra-short baseline measurement of the master AUV through the underwater acoustic communication of the slave AUV T , where L0 and λ0 represent the initial latitude and longitude of the AUV (in degrees), h0 represents the initial height of the AUV (in meters), and T represents the matrix transpose;

[0109] (4) Calculate the local gravitational acceleration:

[0110] g=g0(1+0.0053024 sin 2 L0-0.0000058sin2 2 L0)

[0111] Calculate the radius of curvature R of the Earth's meridian M , the principal curvature radius of the circle R N :

[0112]

[0113] (5) Set sensor parameters: SINS sampling period T S , DVL sampling period T D (Unit is s). In the present invention, it is assumed that the installation deviation angle and scale factor between DVL and SINS have been compensated, and the three axes of the carrier coordinate system where DVL is located coincide with the three axes of the carrier coordinate system where SINS is located. In addition, since the sampling frequency of DVL is lower than that of SINS, when t k When DVL is not sampled at the moment, let the current sampling time t k The DVL output is the last sampling time t k-1 DVL output.

[0114] (6) Set the coarse alignment time to T C (in s), the sliding window length is w (in s).

[0115] Specific implementation method 2: This implementation method is different from the specific implementation method 1 in that the specific process of step 3 is as follows:

[0116] Transform the pose matrix Decomposed into the form of two matrix multiplications, namely represents the attitude transformation matrix from the earth coordinate system to the navigation coordinate system, Represents the attitude transformation matrix from the geocentric inertial coordinate system to the earth coordinate system;

[0117]

[0118] Where L0 and λ0 represent the start time of the main AUV acoustic measurement alignment from the AUV longitude and latitude, respectively, in degrees, t0 represents the start time of the rough alignment, ω ie represents the angular velocity of the Earth's rotation, T S is the SINS sampling period.

[0119] The other steps and parameters are the same as those in the first embodiment.

[0120] Specific implementation method three: This implementation method is different from specific implementation methods one or two in that the specific process of step four is as follows:

[0121]

[0122] Among them, I 3×3 is the 3×3 identity matrix, It is the attitude transformation matrix from the carrier coordinate system to the carrier inertial coordinate system at the initial moment of alignment. is at k At the moment, the attitude conversion matrix from the carrier coordinate system to the carrier inertial coordinate system at the initial moment, is at k-1 At the moment, the attitude conversion matrix from the carrier coordinate system to the carrier inertial coordinate system at the initial moment, They represent the components of the angular velocity information output by the SINS gyroscope on the three axes of the carrier coordinate system, φ k × Represents φ k The antisymmetric matrix is ​​formed, and “|*|” represents the modulo operation.

[0123] The other steps and parameters are the same as those in the first or second embodiment.

[0124] Specific implementation method 4: This implementation method is different from any one of the specific implementation methods 1 to 3 in that the antisymmetric matrix φ k × for:

[0125]

[0126] The other steps and parameters are the same as those in Specific Embodiments 1 to 3.

[0127] Specific implementation method 5: This implementation method is different from any one of the specific implementation methods 1 to 4 in that, in step 5, t k The projection of the gravitational acceleration in the geocentric inertial coordinate system at the moment g i (t k )for:

[0128]

[0129] in, For the matrix The transposed matrix, g n Represents the projection of gravity acceleration in the navigation coordinate system, g n =[0 0 -g] T , g represents the acceleration due to gravity, g = g0 (1 + 0.0053024sin 2 L0-0.0000058sin 2 2L0), g0 is the Earth's gravitational constant;

[0130] The k The projection of the gravitational acceleration at the initial moment on the carrier's inertial coordinate system for:

[0131]

[0132] The other steps and parameters are the same as those in Specific Embodiments 1 to 4.

[0133] By transforming the relative force equation, we can obtain

[0134]

[0135] Among them, f b (t k ) represents the projection of the specific force measured by the accelerometer in the carrier coordinate system; v n (t k ) represents the projection of the carrier's ground velocity in the navigation coordinate system; represents the projection of the earth's rotation angular velocity in the navigation coordinate system, It represents the projection of the angular velocity of the navigation coordinate system relative to the earth coordinate system in the navigation coordinate system. yes The antisymmetric matrix, They represent the eastward, northward, and celestial velocity components of the carrier's ground velocity in the navigation coordinate system respectively; g b Represents the projection of gravitational acceleration in the carrier coordinate system.

[0136] In the coarse alignment process, the AUV is suspended in the water, so the interference caused by the linear motion in equation (8) is ignored, so equation (8) can be simplified to f b (t k )≈-g b (t k ), and then get Update method.

[0137] Specific implementation method 6: This implementation method is different from the specific implementation methods 1 to 5 in that the specific process of step 7 is as follows:

[0138] The accelerometer data obtained at each sampling moment is processed using a sliding time window:

[0139]

[0140] Among them, f b (t j ) indicates t j The acceleration information output by the SINS accelerometer at time t, w represents the length of the sliding time window;

[0141] Select the smallest s k, the smallest s k Denoted as s a , will s a The corresponding sampling time period [t a ,t a+w-1 ] as the first integration interval selected.

[0142] The other steps and parameters are the same as those in Specific Implementation Methods 1 to 5.

[0143] This embodiment selects the data segment corresponding to the window with the smallest average combined interference acceleration through a sliding window, and then uses the selected data segment to construct a reference vector and an observation vector, thereby improving the alignment accuracy.

[0144] Specific implementation method 7: This implementation method is different from the specific implementation methods 1 to 6 in that the specific process of step 8 is as follows:

[0145] Step 81: Create a reference vector and

[0146]

[0147] Points:

[0148]

[0149] Step 82: Establish observation vector and

[0150]

[0151] Step 83: Calculate the attitude transformation matrix based on the observation vector and the reference vector

[0152]

[0153] Among them, the superscript -1 represents inversion, and the superscript T represents transposition.

[0154] The other steps and parameters are the same as those in Specific Embodiments 1 to 6.

[0155] Specific implementation eight: This implementation differs from specific implementations one to seven in that the t k The attitude conversion matrix from the carrier coordinate system to the navigation coordinate system at this moment is:

[0156]

[0157] in, is the initial estimated attitude transformation matrix, yes The transposed matrix of .

[0158] The other steps and parameters are the same as those in Specific Embodiments 1 to 7.

[0159] Specific implementation method 9: This implementation method is different from specific implementation methods 1 to 8 in that the specific process of step 10 is as follows:

[0160]

[0161] in, represents the compensated accelerometer output; Represents the attitude transformation matrix The transpose of Indicates t k The projection of the AUV velocity output by DVL in the carrier coordinate system at the moment; yes The antisymmetric matrix of h0 represents the initial height of the AUV, R N is the principal curvature radius of the y-axis circle, R M is the principal radius of curvature of the meridian, in m;

[0162] but for:

[0163]

[0164] The other steps and parameters are the same as those in Specific Embodiments 1 to 8.

[0165] Specific implementation method 10: This implementation method is different from the specific implementation methods 1 to 9 in that the specific process of step 11 is as follows:

[0166]

[0167] in, and is the updated observation vector;

[0168]

[0169] in, is the updated attitude transformation matrix from the geocentric inertial coordinate system to the carrier inertial coordinate system at the initial moment;

[0170]

[0171] in, It is the final estimated attitude transformation matrix from the carrier coordinate system to the navigation coordinate system;

[0172] Then the posture transformation matrix Perform orthogonal processing to obtain the posture transformation matrix after orthogonal processing

[0173] The other steps and parameters are the same as those in Specific Embodiments 1 to 9.

[0174] Experimental Section

[0175] Actual test data was used for test verification, and the test was conducted in Lake A. Limited by the test conditions, the AUV in the present invention was aligned in the water surface environment, and GPS was used as a benchmark for judging the alignment results. The test equipment included a GPS receiver, SINS, DVL, and USBL.

[0176] Since there is no real attitude angle as a reference in the actual measurement, the effectiveness of the method proposed in the present invention cannot be directly evaluated. Therefore, SINS / DVL dead reckoning is performed after the rough alignment is completed, and the positioning error of the dead reckoning is used to indirectly reflect the alignment accuracy.

[0177] First, the master and slave AUVs hover on the water surface. The master AUV measures and transmits the position of the slave AUV at the start of alignment through UBSL. The slave AUV uses the DV-ADIA method and the method proposed in this invention to perform coarse alignment for 5 minutes to obtain the initial attitude angle. After the coarse alignment is completed, the initial attitude angle and DVL data are used for SINS / DVL dead reckoning. Finally, the dead reckoning positioning error is obtained through the GPS position reference. The sampling period T of the measured SINS S =1 / 200s, DVL sampling period T D =1s, alignment time T C =300s, sliding window length w=120s.

[0178] Since the main error sources of SINS / DVL dead reckoning are the initial alignment error and the DVL velocity error, when the DVL errors of the two coarse alignment methods are consistent, the dead reckoning positioning error result can reflect the size of the initial alignment error, thereby verifying the effectiveness of the method proposed in this invention.

[0179] Figure 2 The first integration interval of the DV-ADIA method is compared with the average interference acceleration of the integration interval selected by the sliding window of the present invention. Figure 2 It can be seen that the combined disturbance acceleration of the coarse alignment method of the present invention is smaller than that of the DV-ADIA method. Figure 3 Comparison of trajectory curves after dead reckoning for the two alignment methods. Figure 4 Comparison of positioning errors after dead reckoning for the two alignment methods. Figure 3 and 4It can be seen that the dead reckoning positioning error of the rough alignment method of the present invention is significantly reduced compared with the DV-ADIA method, which shows that the present invention better suppresses the adverse effects of the interference acceleration on the alignment result, and effectively improves the alignment accuracy.

[0180] The above calculation examples of the present invention are only used to explain the calculation model and calculation process of the present invention in detail, and are not intended to limit the implementation methods of the present invention. For ordinary technicians in the relevant field, other different forms of changes or modifications can be made based on the above description. It is impossible to list all the implementation methods here. All obvious changes or modifications derived from the technical solution of the present invention are still within the scope of protection of the present invention.

Claims

1. A method for rough alignment of underwater AUV based on acoustic positioning, characterized in that: The method specifically comprises the following steps: Step 1: The slave AUV receives the position information of the slave AUV obtained by ultra-short baseline measurement of the master AUV at the start time of alignment through underwater acoustic communication; Step 2: Collect t from AUV k The acceleration information output by the SINS accelerometer, the angular velocity information output by the SINS gyroscope, and the velocity information output by the DVL at the moment; The acceleration information output by the SINS accelerometer is expressed as: in, and Respectively represent t k The components of the specific force measured by the SINS accelerometer on the three axes of the carrier coordinate system at the moment, in m / s 2 ; The angular velocity information output by the SINS gyroscope is expressed as: in and Respectively represent t k The components of the angular velocity measured by the SINS gyroscope on the three axes of the carrier coordinate system at the moment, in rad / s; The speed information output by DVL is expressed as: in, and Respectively represent t k The rightward speed, forward speed and upward speed of the slave AUV in the carrier coordinate system measured by DVL at the moment, in m / s; Step 3: Update t according to the latitude and longitude information provided by the master AUV k Attitude transformation matrix from inertial coordinate system to navigation coordinate system at the moment Step 4: Update t according to the angular velocity information output by the SINS gyroscope k The carrier coordinate system at the moment to the carrier inertial coordinate system at the initial moment i b0 The attitude transformation matrix Step 5: Based on the acceleration information output by the SINS accelerometer and Get t k The projection of the gravitational acceleration at the initial moment on the carrier's inertial coordinate system According to the local gravity acceleration information and attitude transformation matrix Get t k The projection of the gravitational acceleration in the geocentric inertial coordinate system at the moment g i (t k ); Step 6: Determine whether the alignment is completed; If the alignment is completed, proceed to step seven; If the alignment is not completed, set k=k+1 and return to step 2; Step 7: Select the first integration interval according to the accelerometer data obtained at each sampling time and the set sliding time window; Step 8: g i (t k ) Integrate the first integration interval and the second integration interval selected in step 7 respectively to construct a reference vector; In step 7, the first integration interval and the second integration interval selected are integrated to construct the observation vector; the second integration interval is from the alignment start time t0 to the alignment end time t M The data segment; And calculate the attitude transformation matrix from the geocentric inertial coordinate system to the carrier inertial coordinate system at the initial moment based on the observation vector and the reference vector Step 9: Using the Posture Transformation Matrix and To make a preliminary estimate of t k Attitude transformation matrix from the carrier coordinate system to the navigation coordinate system at the moment Then the initial estimated matrix Perform orthogonal processing to obtain the posture transformation matrix after orthogonal processing Step 10: Use t k Moment-by-moment attitude transformation matrix And DVL output speed information To compensate for k Accelerometer output at all times to get compensation results And according to right Update to get Step 11: Utilization Return to step 8 and recalculate And according to Finally, it is estimated that t k The attitude transformation matrix from the carrier coordinate system to the navigation coordinate system at the moment Then the final estimated posture transformation matrix Perform orthogonal processing to obtain the posture transformation matrix after orthogonal processing Step 12: Transform the matrix according to the posture Solve t k Estimation results of the three attitude angles of the AUV at the moment; Among them, C ij , i,j=1,2,3 represents the attitude transformation matrix The elements in the i-th row and j-th column in , θ, γ, and ψ represent the estimated pitch angle, roll angle, and heading angle, respectively.

2. The underwater AUV rough alignment method based on acoustic positioning according to claim 1 is characterized in that: The specific process of step three is: Transform the pose matrix Decomposed into the form of two matrix multiplications, namely represents the attitude transformation matrix from the earth coordinate system to the navigation coordinate system, Represents the attitude transformation matrix from the geocentric inertial coordinate system to the earth coordinate system; Where L0 and λ0 represent the start time of the main AUV acoustic measurement alignment from the AUV longitude and latitude, respectively, in degrees, t0 represents the start time of the rough alignment, ω ie represents the angular velocity of the Earth's rotation, T S is the SINS sampling period.

3. The underwater AUV rough alignment method based on acoustic positioning according to claim 2 is characterized in that: The specific process of step 4 is as follows: Among them, I 3×3 is the 3×3 identity matrix, It is the attitude transformation matrix from the carrier coordinate system to the carrier inertial coordinate system at the initial moment of alignment. is at k At the moment, the attitude conversion matrix from the carrier coordinate system to the carrier inertial coordinate system at the initial moment, is at k-1 At the moment, the attitude conversion matrix from the carrier coordinate system to the carrier inertial coordinate system at the initial moment, They represent the components of the angular velocity information output by the SINS gyroscope on the three axes of the carrier coordinate system, φ k × Represents φ k The antisymmetric matrix is ​​formed, and "|*|" represents the modulo operation.

4. The underwater AUV rough alignment method based on acoustic positioning according to claim 3 is characterized in that: The antisymmetric matrix φ k × for:

5. The underwater AUV rough alignment method based on acoustic positioning according to claim 4 is characterized in that: In the step 5, t k The projection of the gravitational acceleration in the geocentric inertial coordinate system at the moment g i (t k )for: in, For the matrix The transposed matrix, g n Represents the projection of gravity acceleration in the navigation coordinate system, g n =[00-g] T , g represents the acceleration due to gravity, g = g0 (1 + 0.0053024sin 2 L0-0.0000058sin 2 2L0), g0 is the Earth's gravitational constant; The k The projection of the gravitational acceleration at the initial moment on the carrier's inertial coordinate system for:

6. The underwater AUV rough alignment method based on acoustic positioning according to claim 5 is characterized in that: The specific process of step seven is as follows: The accelerometer data obtained at each sampling moment is processed using a sliding time window: Among them, f b (t j ) indicates t j The acceleration information output by the SINS accelerometer at time t, w represents the length of the sliding time window; Select the smallest s k , the smallest s k Denoted as s a , will s a The corresponding sampling time period [t a ,t a+w-1 ] as the first integration interval selected.

7. The underwater AUV rough alignment method based on acoustic positioning according to claim 6 is characterized in that: The specific process of step eight is as follows: Step 81: Create a reference vector and Points: Step 82: Establish observation vector and Step 83: Calculate the attitude transformation matrix based on the observation vector and the reference vector Among them, the superscript -1 represents inversion, and the superscript T represents transposition.

8. The underwater AUV rough alignment method based on acoustic positioning according to claim 7 is characterized in that: The k The attitude conversion matrix from the carrier coordinate system to the navigation coordinate system at this moment is: in, is the initial estimated attitude transformation matrix, yes The transposed matrix of .

9. The underwater AUV rough alignment method based on acoustic positioning according to claim 8 is characterized in that: The specific process of step ten is as follows: in, represents the compensated accelerometer output; Represents the attitude transformation matrix The transpose of Indicates t k The projection of the AUV velocity output by DVL in the carrier coordinate system at the moment; yes The antisymmetric matrix of h0 represents the initial height of the AUV, R N is the principal curvature radius of the y-axis circle, R M is the principal radius of curvature of the meridian, in m; but for:

10. The underwater AUV rough alignment method based on acoustic positioning according to claim 9, characterized in that: The specific process of step 11 is as follows: in, and is the updated observation vector; in, is the updated attitude transformation matrix from the geocentric inertial coordinate system to the carrier inertial coordinate system at the initial moment; in, It is the final estimated attitude transformation matrix from the carrier coordinate system to the navigation coordinate system; Then the posture transformation matrix Perform orthogonal processing to obtain the posture transformation matrix after orthogonal processing

Citation Information

Cited By

  • Information processing device, control method, program, and storage medium

    US12546604B2

  • Information processing device, control method, program, and storage medium

    US20240369365A1