A digital-analog fusion verification method for underwater glider angle-of-attack corrected dead reckoning
Through the digital-to-analog fusion verification method, combining the multi-type data of the underwater glider and the six-degree of freedom dynamic model, the angle of attack sequence is verified, which solves the problem of angle of attack correction error in the dead reckoning of underwater glider, and improves positioning accuracy and ability Reliability reduces costs.
Patent Information
- Application Number
- CN202411116949.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-15
- Publication Date
- 2024-11-05
- Estimated Expiration
- 2044-08-15
AI Technical Summary
The error of angle of attack correction in the underwater glider dead reckoning results in low accuracy of dead reckoning, and the angle of attack cannot be measured by the instrument, so it needs to be generated through estimation, which affects the positioning accuracy.
By combining the multi-type data sampled by underwater glider navigation with the six-degree of freedom dynamic kinetic model, a comprehensive matrix is constructed to verify whether the candidate angle of attack sequence meets the true motion law, ensuring the reasonableness of dead reckoning Sex and credibility.
It improves the accuracy and credibility of underwater glider dead reckoning, reduces positioning costs, enhances data utilization, and achieves high-precision and highly reliable underwater positioning.
Smart Images

Figure CN118643469B_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the technical field of underwater gliders, and in particular, relates to a digital-analog fusion verification method for dead reckoning of attack angle correction of underwater gliders. Background Art
[0002] Underwater glider dead reckoning can achieve underwater positioning at low cost by calculating the three-dimensional position and speed of the platform through the depth change rate and attitude angle. However, due to the difference in the conversion relationship between the expression of the glider speed in different coordinate systems, dead reckoning needs to rely on the angle of attack to correct the error. In this process, due to the limitations of underwater information perception technology, the angle of attack cannot be measured by instruments, and the value of the angle of attack can only be generated by estimation. Therefore, how to verify whether the estimated angle of attack and the corresponding dead reckoning results conform to the actual motion law of the underwater glider has become the key to improving the accuracy and rationality of glider dead reckoning. Summary of the invention
[0003] The purpose of the present invention is to provide a digital-analog fusion verification method for underwater glider attack angle correction dead reckoning to make up for the deficiencies of the prior art.
[0004] The present invention aims to improve the rationality of the angle of attack correction process for dead reckoning, and establishes a data-model fusion verification mechanism and technical solution for angle of attack correction dead reckoning. The solution uses the angle of attack sequence of the correction dead reckoning as input, multiple types of sampling data combined with the six-degree-of-freedom dynamic kinematic model as the data-driven enhancement model, and the horizontal speed and position as the output of the angle of attack correction dead reckoning verification solution, aiming to ensure that the angle of attack correction of dead reckoning conforms to the real underwater glider motion law, and finally realize accurate and reasonable underwater glider dead reckoning, so as to provide a reliable underwater position and speed reference for the positioning and observation application of the underwater glider. The present invention aims to provide an accurate and reliable underwater positioning solution for underwater gliders by verifying the correction effect of the angle of attack on dead reckoning.
[0005] To achieve the above object, the present invention is achieved through the following technical solutions:
[0006] A digital-analog fusion verification method for underwater glider attack angle correction dead reckoning includes the following steps:
[0007] Step 1: Collect data, including the data sampled by the underwater glider and the angle of attack sequence data corrected by dead reckoning;
[0008] Step 2: Convert the OAD of the pull-wire sensor of the oil bag inside the buoyancy engine into the equivalent mass m of the buoyancy engine in the six-degree-of-freedom dynamic model of the underwater glider b ;
[0009] Step 3: Conversion of the movable mass linear potentiometer value to the six-degree-of-freedom dynamic model. Convert the movable mass linear potentiometer value PAD into the coordinate parameter r of the movable mass along the axis in the body coordinate system in the six-degree-of-freedom dynamic model of the underwater glider. m1 ;
[0010] Step 4: Convert the value of the movable mass rotation potentiometer, convert the movable mass rotation potentiometer value RAD into the rotation angle rot of the movable mass around the neutral plane in the six-degree-of-freedom dynamics model of the underwater glider;
[0011] Step 5: Conversion of motion sampling parameters, replacing the motion data sampled by the underwater glider with the six-degree-of-freedom kinematics and dynamics model of the glider;
[0012] Step 6: Construct the input of the glider dynamics model, map the model parameters based on the sampled data, and construct the comprehensive matrix I describing the characteristics of the underwater glider system;
[0013] Step 7: In the hydrodynamic force and hydrodynamic moment calculation of the dynamic model, the sampled data and the angle of attack corrected dead reckoning are integrated;
[0014] Step 8: Execute dynamic model calculation to calculate the three linear accelerations and angular acceleration in the underwater glider body coordinate system;
[0015] Step 9: Verify the candidate angle of attack sequence to determine whether the candidate angle of attack sequence conforms to the motion law of the real underwater glider;
[0016] Step 10: Determine the dead reckoning state of the angle of attack after verification, and complete the final dead reckoning state, including horizontal speed and position, based on the verification of the angle of attack correction, to achieve high-precision and high-reliability underwater glider positioning.
[0017] Furthermore, in step 1, the data sampled during the underwater glider's navigation include: depth Z, roll angle φ, pitch angle θ, heading angle ψ, wire sensor value OAD of the oil bag inside the buoyancy engine, movable mass linear potentiometer value PAD, movable mass rotary potentiometer value RAD; in addition, the following data are calculated using the data sampled during the underwater glider's navigation: vertical speed Z', roll angle change rate φ', pitch angle change rate θ', and heading angle change rate ψ'.
[0018] Furthermore, in step 2, the sensor value OAD is first mapped to the glider external oil bag volume V b The model value of is shown in formula (1):
[0019] (1);
[0020] Among them, V bmid、V bmax 、V bmin 、OAD mid 、OAD max 、OAD min are the median, maximum and minimum values of the external oil bladder volume, and the median, maximum and minimum values of the pull-wire sensor values of the internal oil bladder; calculate the equivalent mass m of the buoyancy engine b , as shown in formula (2):
[0021] (2);
[0022] Among them, ρ oil and ρ water They are the density of the oil filling the buoyancy engine and the density of seawater.
[0023] Furthermore, in step 3, the conversion process is as shown in formula (3):
[0024] (3);
[0025] Among them, r m1mid 、r m1max 、r m1min 、PAD mid 、PAD max 、PAD min They are respectively the median, maximum and minimum values of the coordinate values of the movable mass along the axial direction in the body coordinate system, and the median, maximum and minimum values of the movable mass linear potentiometer values.
[0026] Furthermore, the step 4: conversion of the value of the movable mass rotation potentiometer is shown in formula (4):
[0027] (4);
[0028] Among them, rot mid ,rot max ,rot min , RAD mid , RAD max , RAD min They are the median, maximum and minimum values of the movable mass rotation potentiometer values, and the median, maximum and minimum values of the movable mass rotation angle around the neutral plane.
[0029] Furthermore, in step 5, first, the vertical velocity Z' and the angle change rates φ', θ', ψ' expressed in the geodetic coordinate system are calculated using the depth Z and attitude angles φ, θ, ψ sampled by the underwater glider during navigation;
[0030] Then, the velocity V3 and angular velocity [p, q, r] in the body coordinate system are solved by using the coordinate transformation relationship between the body coordinate system and the earth coordinate system. T , as shown in formulas (5) and (6):
[0031] R BI (5);
[0032] (6);
[0033] Among them, R BI is the matrix for transforming the earth coordinate system to the body coordinate system; X', Y', and Z' are the underwater glider velocities expressed in the earth coordinate system. It is worth noting that X' and Y' are calculated by the model, while Z' is obtained by sampling data;
[0034] Finally, the solved sampling parameters replace the corresponding parameters of the six-degree-of-freedom dynamics and kinematics model.
[0035] Furthermore, the step 6: constructs a comprehensive matrix I describing the characteristics of the underwater glider system, as shown in formula (7):
[0036] (7);
[0037] Among them, m v is the total mass of the underwater glider, which includes a fixed mass m h , movable mass m m and buoyancy engine equivalent mass m b , where m b is one of the input parameters of the six-degree-of-freedom dynamic model; and r m =[r m1 ,r m2 ,r m3 ] T is the radius vector of the movable mass center of mass relative to the center of buoyancy, which is another input of the six-degree-of-freedom dynamic model. Its expression can be further expressed as formula (8):
[0038] (8);
[0039] R m is the rotation radius of the movable mass. In this way, the center of mass position of the underwater glider affected by the buoyancy engine and the movable mass position can be calculated, as shown in formula (9), r h 、r b They are respectively the radius vector of the fixed mass center of mass relative to the center of buoyancy and the radius vector of the buoyancy engine center of mass relative to the center of buoyancy.
[0040] (9);
[0041] In addition, M f =M fij ,i,j=1,2,3,C f =C fij ,i,j=1,2,3,J=J ij ,i,j=1,2,3 are the additional mass matrix, additional damping matrix and total inertia matrix of underwater glider respectively;
[0042] After clarifying the value of the comprehensive matrix I, it is necessary to calculate the inverse matrix I of the matrix -1 And the time derivative I' of the matrix is used to prepare for the next step of calculating the linear acceleration and angular acceleration of the underwater glider.
[0043] Furthermore, in step 7, the dynamic model, the sampling data and the angle of attack sequence are integrated. Specifically, the hydrodynamics of the underwater glider is expressed as: F h =R BC [-D,SF,-L] T , where R BC is the conversion matrix from the flow system to the aircraft system, D, SF, and L are the drag, side force, and lift of the underwater glider, respectively, which are calculated by the given angle of attack and the combined speed of the underwater glider, and m0g is the net buoyancy; and the hydrodynamic moment of the underwater glider is expressed as: F h =R BC [M1,M2,M3] T , where M i , i=1,2,3 are hydrodynamic torque components, which are calculated by angle of attack and angular velocity. After the fusion of angle of attack and sampling data is realized through the above process, the resultant external force and torque T, F of the underwater glider expressed in the computer body coordinate system are shown in equations (10) to (11):
[0044] (10);
[0045] (11).
[0046] Furthermore, in step 8, this step is the core step of implementing digital-analog fusion for the angle of attack, and the calculation principle of the dynamic model is shown in formula (12):
[0047] (12);
[0048] Among them, P and Π are the momentum and angular momentum expressed in the body system of the underwater glider respectively. The calculation of their derivatives requires matching the derivatives of momentum and angular momentum through the total external force and total external torque of the underwater glider expressed in the inertial system, and then expressing them in the body system through coordinate transformation, and finally expressing the total external force and total external torque T and F of the underwater glider in the body coordinate system; after obtaining the acceleration and angular acceleration in the body coordinate system of the underwater glider, integrate the horizontal acceleration to obtain the velocity in the body coordinate system, and then obtain the horizontal velocity X', Y' in the earth system through coordinate transformation, and further integrate to obtain the horizontal position X, Y in the earth system.
[0049] Further, in step 9, specifically, the angle of attack sequence is input in sequence, and the horizontal speed X', Y' and position X, Y of the geodetic coordinate system are output; since the angle of attack correction dead reckoning is mainly based on the kinematic model of the underwater glider to judge the difference between the dead position and the surface satellite positioning coordinates, the dynamic process introduced in the present invention fuses the angle of attack and the sampling data, and verifies the candidate angle of attack sequence through hydrodynamic calculation, actuator operation state input, coordinate transformation, etc.; by further judging whether the verified horizontal position conforms to the satellite positioning coordinates, the rationality of the angle of attack correction dead reckoning is verified.
[0050] Compared with the prior art, the advantages and beneficial effects of the present invention are:
[0051] The present invention integrates multiple types of inputs of underwater glider navigation sampling into the six-degree-of-freedom dynamics and kinematics model, and implements the verification of the angle-of-attack corrected dead reckoning, including the conversion of actuator operation signals to six-degree-of-freedom dynamics model parameters; the replacement of depth and attitude angle and their corresponding vertical velocity and angular velocity with the parameters of the dynamics model and the kinematics model; and the hydrodynamic calculation combining the mixed vector composed of the model calculation speed, the model calculation angular velocity, the sampling speed, and the sampling angular velocity with the angle of attack.
[0052] The present invention achieves the following effects by establishing a data-model fusion verification mechanism for angle of attack corrected dead reckoning:
[0053] (1) Improving the utilization rate of underwater glider navigation sampling data:
[0054] The present invention helps to improve the utilization rate of underwater glider sampling data. By incorporating actuator operation data, depth, attitude data and angle of attack sequence into the six-degree-of-freedom dynamics and kinematics model, a data-driven enhanced model for underwater gliders is established. The model verifies the correction effect of the angle of attack on dead reckoning by mining the motion characteristics contained in the actual sampling data, thereby improving the utilization rate of underwater glider navigation sampling data.
[0055] (2) Improving the reliability of dead reckoning:
[0056] The present invention establishes a data-model fusion verification scheme for angle of attack correction dead reckoning to ensure that the correction of angle of attack to dead reckoning conforms to the real motion law of underwater gliders. The scheme replaces the dynamic and kinematic calculation process of the six freedoms of the underwater glider with real sampling data, which improves the credibility of the dead reckoning results. Through this scheme, the rationality of horizontal speed and position calculation can be ensured, thereby enhancing the credibility of angle of attack correction dead reckoning.
[0057] (3) Reducing the cost of accurate positioning of underwater gliders:
[0058] The present invention provides a rationality verification method for angle of attack correction dead reckoning, solving the problem of poor credibility of angle of attack correction dead reckoning. Based on the present invention, underwater positioning of underwater gliders can achieve accurate and reliable dead reckoning without relying on high-cost positioning equipment. Therefore, the present invention helps to reduce the cost of underwater glider positioning applications and promote the development of underwater glider observation applications. BRIEF DESCRIPTION OF THE DRAWINGS
[0059] Figure 1 Flowchart of the digital-analog fusion verification method for underwater glider angle of attack corrected dead reckoning.
[0060] Figure 2 The glider sampling data, angle of attack data, speed and angle change rate data required for the implementation of the present invention. Among them, sub-figure (a) is the depth Z of underwater glider navigation sampling; (b) is the vertical speed Z' calculated from the sampling depth; (c) is the sampling pitch angle θ; (d) is the sampling pitch angle change rate θ' over time; (e) is the sampling heading angle ψ; (f) is the sampling heading angle change rate ψ' over time; (g) is the sampling roll angle φ; (h) is the sampling roll angle change rate φ' over time; (i) is the OAD signal of the wire sensor value of the oil bag inside the buoyancy engine for navigation sampling; (j) is the PAD signal of the movable mass linear potentiometer for navigation sampling; (k) is the RAD signal of the movable mass rotary potentiometer for navigation sampling; (l) is the attack angle sequence signal to be verified.
[0061] Figure 3 All data points of the angle of attack candidate queue and their means and the angle of attack sequence after verification and screening.
[0062] Figure 4 The calculation principle of digital-analog fusion of angle of attack sequence.
[0063] Figure 5 The X-coordinate error, Y-coordinate error and Euclidean distance error of the candidate angle of attack sequence after digital model verification with respect to the satellite positioning coordinates.
[0064] Figure 6The statistics of the candidate angle of attack sequence queue on the X coordinate error, Y coordinate error and Euclidean distance error with respect to the satellite positioning coordinates.
[0065] Figure 7 Comparison of dead reckoning without angle of attack correction, dead reckoning corresponding to the mean of all candidate angle of attack sequences, and dead reckoning corresponding to the angle of attack after verification and screening. DETAILED DESCRIPTION
[0066] The technical solution of the present invention is further described below in conjunction with embodiments.
[0067] The data such as actuator status, depth and attitude collected during the navigation of the underwater glider contain rich motion characteristics, which can be used to verify the correction effect of the angle of attack on the dead reckoning. Specifically, the operating signal of the underwater glider actuator can be used as the input of the six-degree-of-freedom dynamic model after conversion, so as to calculate the three-axis acceleration and angular acceleration in the body coordinate system. At the same time, the angle of attack combined with the speed of the glider can solve the hydrodynamic force of the dynamic model. On this basis, the actual collected underwater glider depth, attitude data, and the corresponding vertical velocity and angular velocity replace the parameters of the six-degree-of-freedom dynamic model and kinematic model to realize the integration of data-model. Based on this, the data measured by the underwater glider can be used to verify the quality of the horizontal velocity estimation and realize the verification of the rationality of the dead reckoning results.
[0068] Embodiment 1:
[0069] The basic flow chart of this embodiment is as follows Figure 1 As shown, combined with the sampling data of the 2019 Qingdao sea trial of Ocean University of China and the candidate angle of attack sequence determined by our unit using deep reinforcement learning, the specific technical solution is as follows:
[0070] A digital-analog fusion verification method for underwater glider attack angle correction dead reckoning includes the following steps:
[0071] Step 1: Data preparation. The implementation process of the present invention requires the preparation of two types of data. The first type is the data sampled during the underwater glider's navigation, including: depth Z, roll angle φ, pitch angle θ, heading angle ψ, the wire sensor value OAD of the oil bag inside the buoyancy engine, the movable mass linear potentiometer value PAD, and the movable mass rotary potentiometer value RAD. The second type of data is the attack angle sequence data for correcting dead reckoning. In addition, the following data need to be calculated using the data sampled during the underwater glider's navigation: vertical speed Z', roll angle change rate φ', pitch angle change rate θ', and heading angle change rate ψ'. The above glider sampling data are summarized in Figure 2 , the angle of attack data are listed in Figure 3 .
[0072] Step 2: Conversion of the value of the pull-wire sensor of the oil bladder inside the buoyancy engine. The work of this step is to convert the value of the pull-wire sensor OAD of the oil bladder inside the buoyancy engine into the equivalent mass m of the buoyancy engine in the six-degree-of-freedom dynamic model of the underwater glider. b , which is one of the input parameters of the dynamic model. To this end, we first need to map the sensor value OAD to the volume V of the glider's external oil bag b The model value of is shown in formula (1):
[0073] (1);
[0074] Among them, V bmid =0.4L、V bmax =1.8L、V bmin =1.1L, OAD mid =1575, OAD max =1904, OAD min = 1740. Next, calculate the equivalent mass m of the buoyancy engine b , as shown in formula (2).
[0075] (2);
[0076] Among them, ρ oil =0.9kg\L and ρ water =1.025kg\L.
[0077] Step 3: Conversion of the movable mass linear potentiometer value to the six-degree-of-freedom dynamic model. The work of this step is to convert the movable mass linear potentiometer value PAD into the coordinate parameter r of the movable mass along the axis direction in the body coordinate system in the six-degree-of-freedom dynamic model of the underwater glider. m1 , as shown in formula (3):
[0078] (3);
[0079] Among them, r m1mid =-0.65, r m1max =-0.58, r m1min =-0.7, PAD mid =1848、PAD max =3084、PAD min =612.
[0080] Step 4: Conversion of the movable mass rotation potentiometer value. The work of this step is to convert the movable mass rotation potentiometer value RAD into the rotation angle rot of the movable mass around the neutral plane in the six-degree-of-freedom dynamic model of the underwater glider, as shown in formula (4):
[0081] (4);
[0082] Among them, rot mid =0,rot max =10,rot min =-10, RAD mid =1845, RAD max =2005, RAD min =1685.
[0083] Step 5: Conversion of motion sampling parameters. This step replaces the motion data sampled by the underwater glider into the six-degree-of-freedom kinematic and dynamic model of the glider. First, the depth Z and attitude angles φ, θ, ψ sampled by the underwater glider are used to calculate the vertical velocity Z' and the angular change rate φ', θ', ψ' expressed in the geodetic coordinate system. Next, the velocity V3 and angular velocity [p, q, r] in the body coordinate system are solved with the help of the coordinate conversion relationship between the body coordinate system and the geodetic coordinate system. T , as shown in formulas (5) and (6):
[0084] R BI (5);
[0085] (6);
[0086] Among them, R BI is the matrix for converting the earth coordinate system to the body coordinate system; X', Y', and Z' are the underwater glider speeds expressed in the earth coordinate system. It is worth noting that X' and Y' are calculated by the model, while Z' is obtained through sampling data. Finally, the solved sampling parameters are replaced with the corresponding parameters of the six-degree-of-freedom dynamics and kinematics models.
[0087] Step 6: Construction of glider dynamics model input Based on the model parameter mapping of the sampling data calculated in the previous step, this step constructs the comprehensive matrix I describing the characteristics of the underwater glider system, as shown in formula (7).
[0088] (7);
[0089] Among them, m v is the total mass of the underwater glider, which includes a fixed mass m h =76.6kg, movable mass m m =9.4kg and buoyancy engine equivalent mass m b , where m b is one of the input parameters of the six-degree-of-freedom dynamic model. m =[r m1 ,rm2 ,r m3 ] T is the radius vector of the movable mass center of mass relative to the center of buoyancy, which is another input of the six-degree-of-freedom dynamic model. Its expression can be further expressed as formula (8):
[0090] (8);
[0091] R m =25mm, which is the rotation radius of the movable mass. In this way, the center of mass position of the underwater glider affected by the buoyancy engine and the movable mass position can be calculated, as shown in formula (9), r h =[0.079,0,0.0131] T 、r b =[0.897,0,0] T :
[0092] (9);
[0093] In addition, M f =[1.938,0,0;0,65.509,0;0,0,79.463], C f =[0,0.189,0;0,0,2.944;0,-4.455,0], and the total inertia matrix J of the underwater glider changes with r m and m b And update.
[0094] After clarifying the value of the comprehensive matrix I, it is necessary to calculate the inverse matrix I of the matrix -1 And the time derivative I' of the matrix is used to prepare for the next step of calculating the linear acceleration and angular acceleration of the underwater glider.
[0095] Step 7: Fusion of model, sampled data and angle of attack sequence. This step fuses the sampled data and angle of attack corrected dead reckoning in the hydrodynamic and hydrodynamic moment calculation phase of the dynamic model. Specifically, the hydrodynamic force of the underwater glider can be expressed as: F h =R BC [-D,SF,-L] T , where R BC is the conversion matrix from the flow system to the aircraft system, D, SF, and L are the drag, side force, and lift of the underwater glider, respectively, which are calculated by the given angle of attack and the combined speed of the underwater glider, and m0g is the net buoyancy. The hydrodynamic moment of the underwater glider can be expressed as: F h =R BC [M1,M2,M3] T , where M i, i=1,2,3 are the hydrodynamic torque components, which can be calculated by the angle of attack and angular velocity. After the fusion of the angle of attack and the sampling data is realized through the above process, the resultant external force and torque T, F of the underwater glider expressed in the computer body coordinate system are shown in equations (10) to (11):
[0096] (10);
[0097] (11).
[0098] Step 8: Execute dynamic model calculation. This step calculates the three linear accelerations and angular accelerations in the underwater glider's body coordinate system. It is the core step of implementing digital-analog fusion for the angle of attack. The calculation principle of the dynamic model is shown in formula (12):
[0099] (12);
[0100] Among them, P and Π are respectively the momentum and angular momentum expressed in the underwater glider's body system. The calculation of their derivatives requires matching the derivatives of momentum and angular momentum through the total external force and total external torque of the underwater glider expressed in the inertial system, and then expressing them in the body system through coordinate transformation. Finally, the total external force and total external torque T and F of the underwater glider are expressed in the body coordinate system. After obtaining the acceleration and angular acceleration in the underwater glider's body coordinate system, integrate the horizontal acceleration to obtain the velocity in the body coordinate system, and then use the coordinate transformation to obtain the horizontal velocity X' and Y' in the earth system. Further integration can obtain the horizontal position X and Y in the earth system. The specific calculation principle is as follows: Figure 4 shown.
[0101] Step 9: Verify the candidate angle of attack sequence. This step is based on the verification framework introduced above to determine whether the candidate angle of attack sequence conforms to the actual motion law of the underwater glider. Specifically, the angle of attack sequence is input in sequence, and the horizontal velocity X', Y' and position X, Y of the geodetic coordinate system are output. Since the angle of attack corrected dead reckoning is mainly based on the kinematic model of the underwater glider to judge the difference between the calculated dead position and the surface satellite positioning coordinates, the dynamic process introduced in the present invention fuses the angle of attack and the sampling data, and verifies the candidate angle of attack sequence through hydrodynamic calculations, actuator operating status input, coordinate transformation, etc. By further using the digital-analog fusion solution to determine whether the verified horizontal position conforms to the satellite positioning coordinates, the error result after verification is as follows. Figure 5 and Figure 6 As shown in Figure 2, the angle of attack sequence with the smallest error is selected as the final angle of attack sequence after screening and verification.
[0102] Step 10: Determine the dead reckoning state of the angle of attack after verification. Based on the verification of the angle of attack corrected dead reckoning, this step completes the final determination of the dead reckoning state, including horizontal velocity and position. Figure 7 Compared with the dead reckoning without angle of attack correction, the Euclidean distance error of the dead reckoning with the verified angle of attack is reduced by 97.525%; compared with the mean of all candidate angle of attack sequences, the Euclidean distance error of the dead reckoning with the verified angle of attack is reduced by 98.831%, achieving underwater glider positioning with higher accuracy and reliability.
[0103] Compared with the existing underwater glider positioning solutions, the advantages of the present invention are that it relies on fewer external devices and has lower operating costs when implementing underwater positioning, while also having a higher utilization rate of data sampled during glider navigation. In theory, underwater gliders can be equipped with inertial navigation or acoustic positioning systems to achieve precise underwater positioning, but the energy consumption and costs of these two methods are too high, making them difficult to apply to underwater glider missions on a large scale. For a long time, the various sensor data and motion data collected during underwater glider navigation have not been fully utilized. The digital-analog fusion verification method proposed in the present invention can, on the one hand, construct the position and velocity information of underwater gliders at a low cost; on the other hand, it can realize the integration of underwater glider sampling data and theoretical models, thereby improving the utilization rate of observation data.
[0104] Finally, although this specification is described according to implementation methods, not every implementation method contains only one independent technical solution. This narrative method of the specification is only for the sake of clarity. Those skilled in the art should regard the specification as a whole. The technical solutions in each embodiment can also be appropriately combined to form other implementation methods that can be understood by those skilled in the art.
Claims
1. A digital-analog fusion verification method for underwater glider attack angle correction dead reckoning, characterized in that: The following steps are involved: Step 1: Collect data, including the data sampled by the underwater glider and the angle of attack sequence data corrected by dead reckoning; Step 2: Convert the OAD of the pull-wire sensor of the oil bag inside the buoyancy engine into the equivalent mass m of the buoyancy engine in the six-degree-of-freedom dynamic model of the underwater glider b ; Step 3: Conversion of the movable mass linear potentiometer value to the six-degree-of-freedom dynamic model. Convert the movable mass linear potentiometer value PAD into the coordinate parameter r of the movable mass along the axis in the body coordinate system in the six-degree-of-freedom dynamic model of the underwater glider. m1 ; Step 4: Convert the value of the movable mass rotation potentiometer, convert the movable mass rotation potentiometer value RAD into the rotation angle rot of the movable mass around the neutral plane in the six-degree-of-freedom dynamics model of the underwater glider; Step 5: Conversion of motion sampling parameters, replacing the motion data sampled by the underwater glider into the six-degree-of-freedom kinematics and dynamics model of the glider; Step 6: construct the input of the glider dynamics model, map the model parameters based on the sampled data, and construct the comprehensive matrix I describing the characteristics of the underwater glider system; Step 7: In the hydrodynamic and hydrodynamic moment calculation phase of the dynamic model, the sampling data and the angle of attack corrected dead reckoning are integrated; the hydrodynamic force of the underwater glider is expressed as: F h =R BC [-D,SF,-L] T , where R BC is the conversion matrix from the flow system to the aircraft system, D, SF, and L are the drag, side force, and lift of the underwater glider, respectively, which are calculated by the given angle of attack and the combined speed of the underwater glider, and m0g is the net buoyancy; and the hydrodynamic moment of the underwater glider is expressed as: F h =R BC [M1,M2,M3] T , where M i , i = 1, 2, 3 are hydrodynamic torque components, which are calculated by the angle of attack and angular velocity. After the fusion of the angle of attack and the sampling data is realized through the above process, the resultant external force and torque T, F exerted on the underwater glider expressed in the computer body coordinate system are shown in equations (10) to (11): Step 8: Execute dynamic model calculation to calculate the three linear accelerations and angular acceleration in the underwater glider body coordinate system; Step 9: Verify the candidate angle of attack sequence to determine whether the candidate angle of attack sequence conforms to the actual motion law of the underwater glider; Step 10: Determine the dead reckoning state of the angle of attack after verification, and based on the verification of the corrected dead reckoning at the angle of attack, complete the final determined dead reckoning state, including horizontal speed and position, to achieve underwater glider positioning.
2. The digital-analog fusion verification method according to claim 1, characterized in that: In step 1, the data sampled by the underwater glider navigation include: depth Z, roll angle Pitch angle θ, heading angle ψ, the wire sensor value OAD of the oil bag inside the buoyancy engine, the movable mass linear potentiometer value PAD, the movable mass rotary potentiometer value RAD; In addition, the following data are calculated from the data sampled during the underwater glider navigation: vertical speed Z', roll angle change rate The pitch angle change rate θ' and the heading angle change rate ψ'.
3. The digital-analog fusion verification method according to claim 1, characterized in that: In step 2, the sensor value OAD must first be mapped to the glider's external oil bag volume V b The model value of is shown in formula (1): Among them, V bmid 、V bmax 、V bmin 、OAD mid 、OAD max 、OAD min are the median, maximum and minimum values of the external oil bladder volume, and the median, maximum and minimum values of the pull-wire sensor values of the internal oil bladder; calculate the equivalent mass m of the buoyancy engine b , as shown in formula (2): m b =V bmax ×ρ oil +(V bmax -V b )×ρ water (2) Among them, ρ oil and ρ water They are the density of the oil filling the buoyancy engine and the density of seawater.
4. The digital-analog fusion verification method according to claim 1, characterized in that: In step 3, the conversion process is shown in formula (3): Among them, r m1mid 、r m1max 、r m1min 、PAD mid 、PAD max 、PAD min They are respectively the median, maximum and minimum values of the coordinate values of the movable mass along the axial direction in the body coordinate system, and the median, maximum and minimum values of the movable mass linear potentiometer values.
5. The digital-analog fusion verification method according to claim 1, characterized in that: The step 4: conversion of the value of the movable mass rotary potentiometer is shown in formula (4): Among them, rot mid ,rot max ,rot min , RAD mid , RAD max , RAD min They are the median, maximum and minimum values of the movable mass rotation potentiometer values, and the median, maximum and minimum values of the movable mass rotation angle around the neutral plane.
6. The digital-analog fusion verification method according to claim 1, characterized in that: In step 5, first, the depth Z and attitude angle of the underwater glider are sampled. θ, ψ calculate the vertical velocity Z' and angle change rate expressed in the geodetic coordinate system θ', ψ'; Then, the velocity V3 and angular velocity [p, q, r] in the body coordinate system are solved by using the coordinate transformation relationship between the body coordinate system and the earth coordinate system. T , as shown in formulas (5) and (6): Among them, R BI is the matrix for transforming the earth coordinate system to the body coordinate system; X', Y', and Z' are the underwater glider velocities expressed in the earth coordinate system. It is worth noting that X' and Y' are calculated by the model, while Z' is obtained by sampling data; Finally, the solved sampling parameters replace the corresponding parameters of the six-degree-of-freedom dynamics and kinematics model.
7. The digital-analog fusion verification method according to claim 1, characterized in that: Step 6: construct a comprehensive matrix I describing the characteristics of the underwater glider system, as shown in formula (7): Among them, m v is the total mass of the underwater glider, which includes a fixed mass m h , movable mass m m and buoyancy engine equivalent mass m b , where m b is one of the input parameters of the six-degree-of-freedom dynamic model; and r m =[r m1 ,r m2 ,r m3 ] T is the radius vector of the movable mass center of mass relative to the center of buoyancy, which is another input of the six-degree-of-freedom dynamic model. Its expression is expressed as formula (8): r m =[r m1 ,R m ·sin(rot),R m ·cos(rot)] T (8) R m is the radius of rotation of the movable mass; Calculate the center of mass position of the underwater glider affected by the buoyancy engine and the movable mass position, as shown in formula (9), r h 、r b They are respectively the radius vector of the fixed mass center of mass relative to the center of buoyancy and the radius vector of the buoyancy engine center of mass relative to the center of buoyancy: M f =M fij ,i,j=1,2,3、C f =C fij ,i,j=1,2,3、J=J ij , i, j = 1, 2, 3 are the additional mass matrix, additional damping matrix and total inertia matrix of the underwater glider respectively; After determining the value of the comprehensive matrix I, it is necessary to calculate the inverse matrix I-1 of the matrix and the time derivative I' of the matrix.
8. The digital-analog fusion verification method according to claim 1, characterized in that: In step 8, the calculation principle of the kinetic model is shown in formula (12): Among them, P and Π are the momentum and angular momentum expressed in the body system of the underwater glider respectively. The calculation of their derivatives requires matching the derivatives of momentum and angular momentum through the total external force and total external torque of the underwater glider expressed in the inertial system, and then expressing them in the body system through coordinate transformation, and finally expressing the total external force and total external torque T and F of the underwater glider in the body coordinate system; after obtaining the acceleration and angular acceleration in the body coordinate system of the underwater glider, integrate the horizontal acceleration to obtain the velocity in the body coordinate system, and then obtain the horizontal velocity X', Y' in the earth system through coordinate transformation, and further integrate to obtain the horizontal position X, Y in the earth system.
9. The digital-analog fusion verification method according to claim 1, characterized in that: In step 9, the angle of attack sequence is input in sequence, and the horizontal speed X', Y' and position X, Y of the geodetic coordinate system are output; the introduced dynamic process fuses the angle of attack and the sampling data, and the candidate angle of attack sequence is verified through hydrodynamic calculation, actuator operation status input, and coordinate transformation; by further judging whether the verified horizontal position conforms to the satellite positioning coordinates, the rationality of the angle of attack correction dead reckoning is verified.
