Underwater dynamic target positioning method based on sound rays and motion compensation
By establishing motion effects and acoustic ray bending models, and combining maximum likelihood estimation and Newton's iteration method, the error problems caused by acoustic ray bending and nodal motion in underwater target localization were solved, and higher-precision underwater dynamic target localization was achieved.
Patent Information
- Application Number
- CN202410977340.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-22
- Publication Date
- 2024-11-12
AI Technical Summary
Existing technologies neglect the effects of acoustic ray bending and nodal motion in underwater target localization, resulting in insufficient localization accuracy.
By establishing a time delay and Doppler frequency measurement model under motion effects and acoustic ray bending, and combining maximum likelihood estimation and Newton's iteration method, the influence of underwater target motion and acoustic ray bending is compensated. The positioning accuracy is improved by using time delay and Doppler frequency information for iterative solution.
It effectively improves the positioning accuracy of underwater dynamic targets, adapts to real underwater environments, and reduces positioning errors.
Smart Images

Figure CN118938229A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the technical field of underwater acoustic sensor networks, and in particular to an underwater dynamic target positioning method based on sound rays and motion compensation. Background Art
[0002] With the continuous development and utilization of marine resources, underwater acoustic sensor networks (UASN) have been widely used in marine monitoring, resource exploration, disaster warning, seabed mapping, environmental protection and other aspects. Among them, accurate underwater sensor location information is crucial to complete the above applications. However, in the actual underwater environment, the positioning of mobile targets based on acoustic signals mainly faces the following challenges: First, the underwater sound speed is related to many factors such as depth, temperature, density and salinity, resulting in the phenomenon of sound line bending; second, the motion effect of underwater sensors during signal observation is significant relative to the speed of acoustic signals, so when establishing a measurement model, its motion effect cannot be ignored.
[0003] Patent application CN114924229A discloses a clock-asynchronous time-delay-Doppler domain underwater target differential positioning method, which uses time delay and Doppler information to estimate the underwater target position, velocity and clock parameters. The invention assumes that underwater signals are transmitted in a straight line, ignoring the sound line bending problem caused by the stratification effect. In addition, the method also ignores the node motion effect during signal observation. The paper "Localization of a moving source by frequency measurements" proposes the importance of considering the node motion effect during signal observation for positioning in an underwater environment, and establishes corresponding time delay and Doppler measurement models. This method is based on the assumption that the acoustic signal propagates in a straight line. However, in an actual underwater environment, ignoring the underwater stratification effect and node motion effect will introduce large errors to the positioning results. Therefore, it is necessary to study an underwater target positioning method that is more suitable for the actual underwater environment to improve the accuracy of target positioning. Summary of the invention
[0004] The purpose of the present invention is to provide an underwater dynamic target positioning method based on sound rays and motion compensation to improve the underwater dynamic target positioning accuracy.
[0005] The purpose of the present invention can be achieved by the following technical solutions:
[0006] An underwater dynamic target positioning method based on sound rays and motion compensation comprises the following steps:
[0007] Obtain the time delay measurement information and Doppler frequency measurement information obtained by M dynamic underwater sensor nodes measuring the underwater dynamic target, and combine them into a total measurement vector;
[0008] Establishing a time delay and Doppler frequency measurement model under motion effect and sound line bending, and further establishing a maximum likelihood estimation based on the total measurement vector;
[0009] A measurement model under the assumption of straight-line transmission of sound rays is established, and the least square method is used to solve it to obtain the initial position and velocity of the underwater dynamic target;
[0010] Based on the maximum likelihood estimation, the initial position and velocity are used as the initial solution of the Newton iteration method, and an iterative solution is performed to obtain the position and velocity of the underwater dynamic target, thereby completing the positioning process.
[0011] Further, the step of combining the time delay measurement information and the Doppler frequency measurement information into a total measurement vector includes:
[0012] Based on the time delay measurement information and Doppler frequency measurement information, they are converted into vector forms respectively:
[0013] τ=[t1,t2,…,t M ] T =τ o +Δτ,
[0014] f=[f1,f2,…,f M ] T =f o +Δf,
[0015] Where τ is the vector form of the time delay measurement information, f is the vector form of the Doppler frequency measurement information, and t i is the delay measurement information obtained by sensor i, f i is the Doppler frequency measurement information obtained by sensor i, τ o and f o Indicates the real time delay information and Doppler frequency information, Δτ=[Δt1,…,Δt M ] T , Δf=[Δf1,…,Δf M ] T , Δt i and Δf i All of them obey the Gaussian distribution with mean 0;
[0016] Combine the transformed vector forms to get the total measurement vector:
[0017] α=[τ T ,fT ] T =α o +Δα,
[0018] Where α is the total measurement vector, τ T ,f T are the transpose of τ and f, respectively, o =[(τ o ) T ,(f o ) T ] T is the true combination vector form, Δα=[Δτ T ,Δf T ] T is a Gaussian distribution with a mean of 0, and its covariance matrix is
[0019] Furthermore, the steps of establishing a time delay and Doppler frequency measurement model under motion effect and sound line bending include:
[0020] Considering the motion effect, the real time delay information and Doppler frequency information expressions are established:
[0021]
[0022] In the formula, is the i-th real delay information, represents the time delay of the detection signal from sensor i to the target, represents the time delay of the signal reflected from the target to sensor i. represents the target position when the signal from sensor i reaches the target and is reflected, is the position of sensor i when it emits the detection signal, represents the position of sensor i when the signal sent by sensor i is reflected back, f i c represents the carrier frequency of the detection signal emitted by sensor i, represents the position of sensor i when the signal sent by sensor i is reflected back, f i c represents the carrier frequency of the detection signal emitted by sensor i, express Taking the derivative with respect to time, express Take the derivative with respect to time;
[0023] Considering the stratification effect, we establish and and The expression of time delay and Doppler frequency measurement model is completed.
[0024] Furthermore, the and The expression is:
[0025]
[0026] Where a is the sound velocity gradient, and They respectively represent that after sensor i emits a detection signal, sensor i and the target The ray angle at is the position of sensor i when it emits the detection signal, represents the target position when the signal from sensor i reaches the target and is reflected, and They respectively represent when the detection signal is reflected back, sensor i is and the target The ray angle at is the position of sensor i when the signal sent by sensor i is reflected back.
[0027] Furthermore, the and The expression is:
[0028]
[0029] in,
[0030]
[0031]
[0032] Where a is the sound velocity gradient, and They respectively represent that after sensor i emits a detection signal, sensor i and the target The ray angle at is the position of sensor i when it emits the detection signal, represents the target position when the signal from sensor i reaches the target and is reflected, and They respectively represent when the detection signal is reflected back, sensor i is and the target The ray angle at is the position of sensor i when the signal emitted by sensor i is reflected back. Specifically, b i Indicates that sensor i is from and the target from The angle of the straight line relative to the horizontal axis, v i,x ,v i,y ,v i,z They are respectively represented as the speed of sensor i on the X-axis, Y-axis, and Z-axis, r i Indicates that sensor i is With the target The horizontal distance, d i Indicates that sensor i is With the target The distance at i Indicates that sensor i is from and the target from The angle at which the actual sound trajectory deviates from the straight line is b is the speed of sound on the water surface, Indicates that sensor i is from and the target from The angle of the straight line relative to the horizontal axis, Indicates that sensor i is With the target The horizontal distance, d i Indicates that sensor i is With the target The distance between Indicates that sensor i is from and the target from The angle at which the actual sound trajectory deviates from the straight line is
[0033] Furthermore, the expression of the maximum likelihood estimation is:
[0034]
[0035] In the formula, J t,f (θ) is the maximum likelihood estimate, α is the total measurement vector, h(θ)=[τ(θ) T ,f(θ) T ] T , τ(θ) and f(θ) represent the unknown vector The parameter form of the time delay and Doppler frequency, θ is the position and velocity of the underwater dynamic target, τ(θ) T and f(θ) T are the vector forms of delay measurement information and Doppler frequency measurement information, respectively, T Indicates the target position when the signal from the sensor reaches the target and is reflected. represents the time derivative, is the covariance matrix.
[0036] Further, the steps of obtaining the position and velocity of the underwater dynamic target include:
[0037] Based on the initial solution, the linearized expression of h(θ) is:
[0038]
[0039] Where:
[0040]
[0041] Substitute h(θ) into the expression of the maximum likelihood estimation, and use the Newton iteration method for iterative solution to obtain the final initial position and velocity of the underwater dynamic target. The expression of the Newton iteration process is:
[0042]
[0043] In the formula, θ (0) is the initial solution, represents the initial gradient matrix, θ is the position and velocity of the underwater dynamic target, θ (k+1) is the position and velocity at the (k + 1)-th iteration, is, α is the total measurement vector, is the gradient matrix at the k-th iteration.
[0044] Further, the iterative termination condition for using the Newton iteration method for iterative solution is:
[0045] ||θ (k+1) - θ (k) || < x or k > N max
[0046] In the formula, x is the conditional convergence value, N max is the maximum number of iterations.
[0047] Further, the steps of establishing the measurement model under the assumption of straight ray transmission include:
[0048] Based on the assumption of straight ray transmission, establish the observation equation of the time delay information:
[0049]
[0050] In the formula, c represents the average sound speed, is the i-th true time delay information, is the target position when the detection signal emitted by sensor i reaches the target and is reflected, is the position when sensor i emits the detection signal, represents the speed of sensor i;
[0051] Approximately The observation equation of the time delay information is transformed to obtain the measurement model under the assumption of straight-line transmission of sound rays:
[0052]
[0053] in:
[0054]
[0055] In the formula, is the position of sensor i when it emits the detection signal, represents the target position when the signal from sensor i reaches the target and is reflected, for u o Taking the derivative with respect to time, t i is the position of sensor i when it emits the detection signal, v i represents the speed of sensor i.
[0056] Furthermore, the step of obtaining the initial position and velocity of the underwater dynamic target includes: Substituting the measurement model under the assumption of linear transmission of sound rays, we obtain:
[0057]
[0058] in:
[0059]
[0060] Square both sides of equation (1) and rearrange them to get:
[0061]
[0062] in:
[0063]
[0064] α1=[x o y o ,x o z o ,y o z o ];
[0065]
[0066]
[0067] V Pi =[v i,x v i,y ,vi,x v i,z ,v i,y v i,z ]
[0068] 13=[1,1,1]
[0069] 03=[0,0,0]
[0070] According to γ o Define the unknown vector The vector expression of formula (2) is:
[0071]
[0072] in:
[0073]
[0074] ξ t =C t Δτ
[0075]
[0076] By taking the derivative of equation (2) in time, we get the observation equation of Doppler frequency shift information:
[0077]
[0078] in:
[0079]
[0080] h i =2+f i o / f i c
[0081]
[0082] The vector expression of formula (4) is:
[0083]
[0084] in:
[0085]
[0086] B t =I M
[0087] ξ f =D f Δf+D t Δτ
[0088]
[0089] Combining equation (2) and equation (4) we get the vector equation under total measurement:
[0090]
[0091] in:
[0092] A1=[A t ,A f ]
[0093] h1=[h t ,h f ]
[0094] B1=blkdiag{B t ,B f}
[0095] ξ=[ξ t ,ξ f ]
[0096] Get the unknown vector Solution:
[0097]
[0098] in:
[0099]
[0100] According to the unknown vector The solution to obtain the initial position and velocity of the underwater dynamic target is:
[0101]
[0102] In the formula, is the i-th real delay information, t i is the position of sensor i when it emits the detection signal, γ o is an auxiliary variable, is the coefficient matrix of auxiliary variables, x o ,y o , z o Respectively represent the position of the underwater target on the X-axis, Y-axis, and Z-axis, represents the velocity of sensor i, v i,x ,v i,y ,v i,z They are respectively represented as the speed of sensor i on the X-axis, Y-axis, and Z-axis, C t is a diagonal matrix, Δτ is a Gaussian distribution with a mean of 0, and f i o is the true i-th Doppler frequency, fi c is the carrier frequency of the detection signal emitted by sensor i, q i,f is the coefficient matrix of auxiliary variables, I M is the identity matrix of dimension M×M, D f , D t is a diagonal matrix, W1 is the weight vector, Q1 is the covariance matrix, is the estimated target position, is the estimated target speed.
[0103] Compared with the prior art, the present invention has the following beneficial effects:
[0104] (1) When establishing the time delay and Doppler frequency information measurement model between nodes, the present invention not only considers the sound line bending problem caused by the stratification effect, but also considers the motion effect of the target and sensor nodes within the signal observation period, so that the positioning method can be more adapted to the real underwater environment. Through iterative solution, the accuracy of underwater dynamic target positioning is effectively improved.
[0105] (2) After the maximum likelihood estimation is established, the present invention uses the Newton iterative algorithm to output the speed and position of the moving target. Among them, a measurement model under the assumption of straight-line transmission of sound rays is established, and the target speed and position are output using the least squares method, which provides a good initial solution for the Newton iterative algorithm, can avoid the algorithm from falling into local optimization, and improve the accuracy of the algorithm estimation. BRIEF DESCRIPTION OF THE DRAWINGS
[0106] Figure 1 It is a schematic diagram of the method flow of the present invention;
[0107] Figure 2 The time delay and Doppler frequency measurement model under the motion effect and sound line bending of the present invention;
[0108] Figure 3 This is a diagram showing the effect of sound line bending caused by the layering effect of the present invention;
[0109] Figure 4 The RMSE of the underwater dynamic target position of the present invention is as Comparison results of changes in
[0110] Figure 5 The RMSE of the dynamic target speed of the present invention is as follows The comparison results of the changes in . DETAILED DESCRIPTION
[0111] The present invention is described in detail below in conjunction with the accompanying drawings and specific embodiments. This embodiment is implemented based on the technical solution of the present invention, and provides a detailed implementation method and specific operation process, but the protection scope of the present invention is not limited to the following embodiments.
[0112] This embodiment provides an underwater dynamic target positioning method based on sound rays and motion compensation. Figure 1 As shown, the method comprises the following steps:
[0113] Step 1: Obtain delay measurement information and Doppler frequency measurement information.
[0114] Step 1-1: Deploy M dynamic sensors in the positioning water area to measure the speed and position of the dynamic target. Assume that the initial position of the target is u o =[x o ,y o ,z o ] T , at a constant speed during the observation time Perform linear movement. The initial position of the i-th sensor is At a constant speed during the observation time Perform linear movement, where i = 1, 2, …, M, and each sensor can measure the time delay of the target reflection signal and the Doppler frequency shift information caused by movement.
[0115] Step 1-2: Combine the measured time delay and Doppler frequency information into a vector form, as shown below:
[0116] τ=[t1,t2,…,t M ] T =τ o +Δτ, (1)
[0117] f=[f1,f2,…,f M ] T =f o +Δf, (2)
[0118] Among them, t i and f i Represents the time delay information and Doppler frequency information measured by sensor i. τ o and f o Indicates the real time delay information and Doppler frequency information, and Δτ and Δf represent the measurement noise of the delay and Doppler frequency shift information, Δτ=[Δt1,…,Δt M ] T and Δf=[Δf1,…,Δf M ] T , Δti and Δf i All are assumed to follow a Gaussian distribution with mean 0.
[0119] Step 1-3: Combine the time delay and Doppler frequency information into a vector form, which can be expressed as:
[0120] α=[τ T ,f T ] T =α o +Δα, (3)
[0121] Among them, α o =[(τ o ) T ,(f o ) T ] T , Δα=[Δτ T ,Δf T ] T It obeys a Gaussian distribution with a mean of 0, and its covariance matrix is
[0122] Step 2: Establish a time delay and Doppler frequency measurement model under the sound line bending and motion effects. On this basis, establish the maximum likelihood estimation and use the Newton iterative algorithm to solve the precise speed and position of the target.
[0123] Step 2-1: During the signal observation time, the target and the underwater sensor are in relative motion. The motion model is as follows: Figure 2 Taking into account the motion effect, the actual time delay information and Doppler frequency information expressions are as follows:
[0124]
[0125]
[0126] in, represents the target position when the signal from sensor i reaches the target and is reflected, Indicates the position of sensor i when the signal sent by sensor i is reflected back. i c Represents the carrier frequency of the detection signal emitted by sensor i. express Taking the derivative with respect to time, express Take the time derivative.
[0127] Step 2-2: Since the underwater sound speed changes with depth, temperature, and salinity, it causes the underwater sound line to bend, such as Figure 3 Therefore, considering the stratification effect, and The specific expression is:
[0128]
[0129] Among them, when sensor i emits a detection signal, and Respectively, in the sensor and goals When the detection signal is reflected back, and Respectively, in the sensor and goals The ray angle at .
[0130] Accordingly, and The specific expression is:
[0131]
[0132] in,
[0133]
[0134] b i Indicates that the slave sensor and goals The angle of the straight line relative to the horizontal axis, α i Indicates that the slave sensor and goals The angle at which the actual sound trajectory deviates from the straight line is Indicates that the slave sensor and goals The angle of the straight line relative to the horizontal axis, Indicates that the slave sensor and goals The angle at which the actual sound trajectory deviates from the straight line is a represents the sound velocity gradient, and b is the sound velocity on the water surface.
[0135]
[0136] p i =0.5ar i ;
[0137]
[0138] Step 2-3: Based on the observation model, establish the maximum likelihood estimation as follows:
[0139]
[0140] where h(θ) = [τ(θ) T , f(θ) T T , τ(θ) and f(θ) respectively represent the parametric forms of the time delay and Doppler frequency with respect to the unknown vector , as shown in Formulas (4)-(9).
[0141] Step 2-4: Use the Newton iteration method to solve for the position and velocity θ of the target. According to the initial solution θ (0) , the linearized expression of h(θ) is as follows:
[0142]
[0143] where represents the gradient matrix, and its expression is:
[0144]
[0145] Substitute (11) into (10) and minimize it to obtain the solution of θ. Based on this, the expression of the Newton iteration process is as follows:
[0146]
[0147] where k = 0, 1, 2,... represents the iteration number; θ (k) represents the solution obtained after the k-th iteration process; h(θ (k) ) = [τ(θ (k) ) T , f(θ (k) ) T T represents the values of the time delay and Doppler frequency under the condition of θ (k) ; is the gradient matrix under the condition of θ (k) .
[0148] Step 2-5: Set the iteration termination condition as ||θ (k+1) - θ (k) || < x or k > N max . x is the conditional convergence value, and N max is the maximum number of iterations.
[0149] Step 3: In order to ensure that the Newton iteration method in step 2 can converge to the optimal solution, a measurement model under the assumption of linear transmission of sound rays is established, and the initial position and velocity of the target are solved using the least squares method, which is used as the initial solution of the Newton iteration method.
[0150] Step 3-1: Based on the assumption that sound rays travel in a straight line, establish the observation equation for time delay information.
[0151] When the sound line is transmitted in a straight line, its time delay information model is as follows:
[0152]
[0153] Where c is the average speed of sound. When the movement of the target and the sensor is not significant, Approximately Thus (14) can be transformed into the following expression:
[0154]
[0155] in, a i =c(1-v i 2 c 2 )2;
[0156] Will Substituting into (15) and ignoring the second-order error, we can obtain:
[0157]
[0158] in,
[0159] Square both sides of (16) and rearrange them to obtain:
[0160]
[0161] in,
[0162]
[0163] V Pi =[v i,x v i,y ,v i,x v i,z ,v i,y v i,z ]; 13 = [1,1,1]; 03 = [0,0,0].
[0164] According to γ o , define a new unknown vector Therefore, the vector expression of formula (17) is as follows:
[0165]
[0166] in, B t is a diagonal matrix, ξ t =C t Δτ;C t is a diagonal matrix,
[0167] Step 3-2: Derivative equation (17) in time to obtain the observation equation of Doppler frequency shift information, as shown below:
[0168]
[0169] in, h i =2+f i o f i c ;
[0170]
[0171] Therefore, the vector expression of formula (19) is as follows:
[0172]
[0173] in,
[0174] B t =I M ξ f =D f Δf+D t Δτ;D f is a diagonal matrix, D t is a diagonal matrix,
[0175] Step 3-3: Use the time delay and Doppler frequency information to jointly solve the unknown vector, and combine formula (18) and formula (20) to obtain the vector equation under the total measurement, as shown below:
[0176]
[0177] Where A1=[A t ,A f ]; h1 = [h t ,h f]; B1 = blkdiag{B t ,B f};ξ=[ξ t ,ξ f ].
[0178] Therefore, the unknown vector can be obtained The solution is as follows:
[0179]
[0180] The expression of the weight vector W1 is as follows:
[0181]
[0182] in,
[0183] Step 3-4: According to the solution of step 3-3, the initial position and velocity of the target can be obtained as follows:
[0184]
[0185] Step 3-5: Substitute the initial solution into step 2-4 as the initial solution of Newton's iteration method.
[0186] Figure 4 and Figure 5 It is the result of numerical simulation using the specific implementation of the present invention. The simulation scene is designed as follows: There is 1 underwater target and 24 underwater sensors in the scene. The initial position of the underwater target is u o =[500,800,80] T , the speed is The speed direction is randomly selected. The speed of the underwater sensor is v i =10m / s, and its position coordinates are randomly distributed in 1.5×1.5×0.5km 3 The water area; the water acoustic parameters are set to a = 0.1 and b = 1450m / s; the variances of the independent Gaussian white noise superimposed by the time delay information and the Doppler frequency information are and in Through 1000 Monte Carlo simulations, different RMSE of underwater target position coordinates and velocity vector in the case of . Figure 4 and Figure 5The ordinates are the RMSE of the target position coordinates and velocity vector, in "m"; the RMSE of the underwater target velocity vector, in "m / s". As can be seen from the figure, ignoring the underwater stratification effect and the random value of the initial solution will lead to a decrease in positioning performance. Therefore, the positioning method involved in the present invention can effectively estimate the underwater target position and velocity, and is more suitable for the solution conditions of the underwater positioning environment.
[0187] Although the preferred embodiments of the present invention have been described, those skilled in the art may make other changes and modifications to these embodiments once they have learned the basic creative concept. Therefore, the appended claims are intended to be interpreted as including the preferred embodiments and all changes and modifications that fall within the scope of the present invention.
[0188] Obviously, those skilled in the art can make various changes and modifications to the present invention without departing from the spirit and scope of the present invention. Thus, if these modifications and variations of the present invention fall within the scope of the claims of the present invention and their equivalents, the present invention is also intended to include these modifications and variations.
Claims
1. A method for underwater dynamic target positioning based on sound rays and motion compensation, It is characterized in that The following steps are involved: Obtain the time delay measurement information and Doppler frequency measurement information obtained by M dynamic underwater sensor nodes measuring the underwater dynamic target, and combine them into a total measurement vector; Establishing a time delay and Doppler frequency measurement model under motion effect and sound line bending, and further establishing a maximum likelihood estimation based on the total measurement vector; A measurement model under the assumption of straight-line transmission of sound rays is established, and the least square method is used to solve it to obtain the initial position and velocity of the underwater dynamic target; Based on the maximum likelihood estimation, the initial position and velocity are used as the initial solution of the Newton iteration method, and an iterative solution is performed to obtain the position and velocity of the underwater dynamic target, thereby completing the positioning process.
2. According to claim 1, a method for underwater dynamic target positioning based on sound rays and motion compensation, It is characterized in that The step of combining the time delay measurement information and the Doppler frequency measurement information into a total measurement vector comprises: Based on the time delay measurement information and Doppler frequency measurement information, they are converted into vector forms respectively: T=[τ 1 ,t 2 ,…,t M ] T =t o +Δt, f=[f 1 ,f 2 ,…,f M ] T =f o +Δf, Where τ is the vector form of the time delay measurement information, f is the vector form of the Doppler frequency measurement information, and τ i is the delay measurement information obtained by sensor i, f i is the Doppler frequency measurement information obtained by sensor i, τ o and f o Indicates the real time delay information and Doppler frequency information, Δτ=[Δτ 1 , …, Δτ M ] T , Δf=[Δf 1 , …, Δf M ] T , Δτ i and Δf i All of them obey the Gaussian distribution with mean 0; Combine the transformed vector forms to get the total measurement vector: a=[τ T ,f T ] T =a o +Da, Where α is the total measurement vector, τ T , f T are the transpose of τ and f, respectively, o =[(τ o ) T , (f o ) T ] T is the true combination vector form, Δα=[Δτ T , Δf T ] T is a Gaussian distribution with a mean of 0, and its covariance matrix is 3. The underwater dynamic target positioning method based on sound rays and motion compensation according to claim 1, It is characterized in that The steps to establish the time delay and Doppler frequency measurement model under motion effects and sound line bending include: Considering the motion effect, the real time delay information and Doppler frequency information expressions are established: In the formula, is the i-th real delay information, represents the time delay of the detection signal from sensor i to the target, represents the time delay of the signal reflected from the target to sensor i. represents the target position when the signal from sensor i reaches the target and is reflected, is the position of sensor i when it emits the detection signal, represents the position of sensor i when the signal sent by sensor i is reflected back, f i c represents the carrier frequency of the detection signal emitted by sensor i, express Taking the derivative with respect to time, express Take the derivative with respect to time; Considering the stratification effect, we establish and and The expression of time delay and Doppler frequency measurement model is completed.
4. The underwater dynamic target positioning method based on sound rays and motion compensation according to claim 3, It is characterized in that Said and The expression is: Where a is the sound velocity gradient, and They respectively represent that after sensor i transmits a detection signal, sensor i and the target The ray angle at is the position of sensor i when it emits the detection signal, represents the target position when the signal from sensor i reaches the target and is reflected, and They respectively represent when the detection signal is reflected back, sensor i is and the target The ray angle at is the position of sensor i when the signal sent by sensor i is reflected back.
5. The underwater dynamic target positioning method based on sound rays and motion compensation according to claim 3, It is characterized in that Said and The expression is: in, Where a is the sound velocity gradient, and They respectively represent that after sensor i emits a detection signal, sensor i and the target The ray angle at is the position of sensor i when it emits the detection signal, represents the target position when the signal from sensor i reaches the target and is reflected, and They respectively represent when the detection signal is reflected back, sensor i is and the target The ray angle at is the position of sensor i when the signal emitted by sensor i is reflected back. Specifically, b i Indicates that sensor i is from and the target from The angle of the straight line relative to the horizontal axis, v i,x ,v i,y ,v i,z They are respectively represented as the speed of sensor i on the X-axis, Y-axis, and Z-axis, r i Indicates that sensor i is With the target The horizontal distance, d i Indicates that sensor i is With the target The distance at i Indicates that sensor i is from and the target from The angle at which the actual sound trajectory deviates from the straight line is b is the speed of sound on the water surface, Indicates that sensor i is from and the target from The angle of the straight line relative to the horizontal axis, Indicates that sensor i is With the target The horizontal distance, d i Indicates that sensor i is With the target The distance between Indicates that sensor i is from and the target from The angle at which the actual sound trajectory deviates from the straight line is 6. The underwater dynamic target positioning method based on sound rays and motion compensation according to claim 1, It is characterized in that The expression of the maximum likelihood estimation is: In the formula, J t,f (θ) is the maximum likelihood estimate, α is the total measurement vector, h(θ) = [τ(θ) T ,f(θ) T ] T , τ(θ) and f(θ) represent the unknown vector The parameter form of the time delay and Doppler frequency, θ is the position and velocity of the underwater dynamic target, τ(θ) T and f(θ) T are the vector forms of delay measurement information and Doppler frequency measurement information respectively, u T Indicates the target position when the signal from the sensor reaches the target and is reflected. represents the time derivative, is the covariance matrix.
7. The underwater dynamic target positioning method based on sound rays and motion compensation according to claim 6, It is characterized in that The step of obtaining the position and speed of the underwater dynamic target comprises: According to the initial solution, the linearized expression of h(θ) is: in: Substitute h(θ) into the expression of the maximum likelihood estimation, and use the Newton iteration method to iteratively solve to obtain the final initial position and velocity of the underwater dynamic target, where the expression of the Newton iteration process is: In the formula, θ (0) is the initial solution, represents the initial gradient matrix, θ is the position and velocity of the underwater dynamic target, θ (k+1) is the position and velocity at the k+1th iteration, is, α is the total measurement vector, is the gradient matrix at the kth iteration.
8. The underwater dynamic target positioning method based on sound rays and motion compensation according to claim 7, It is characterized in that The iterative termination condition for iterative solution using Newton iteration method is: ||θ (k+1) -θ (k) ||<ζ or k>N max In the formula, ζ is the conditional convergence value, N max is the maximum number of iterations.
9. The underwater dynamic target positioning method based on sound rays and motion compensation according to claim 1, It is characterized in that The step of establishing a measurement model under the assumption of straight-line transmission of sound rays comprises: Based on the assumption that sound rays travel in a straight line, the observation equation for time delay information is established: In the formula, c represents the average speed of sound, is the i-th real delay information, is the target position when the detection signal emitted by sensor i reaches the target and is reflected, is the position of sensor i when it emits the detection signal, represents the speed of sensor i; Approximately The observation equation of the time delay information is transformed to obtain the measurement model under the assumption of straight-line transmission of sound rays: in: and i =c(1-||v i || 2 / c 2 ) / 2 In the formula, is the position of sensor i when it emits the detection signal, represents the target position when the signal from sensor i reaches the target and is reflected, for u o Taking the derivative with respect to time, t i is the position of sensor i when it emits the detection signal, v i represents the speed of sensor i.
10. The underwater dynamic target positioning method based on sound rays and motion compensation according to claim 9, It is characterized in that The step of obtaining the initial position and velocity of the underwater dynamic target comprises: Will Substituting the measurement model under the assumption of linear transmission of sound rays, we obtain: in: Square both sides of equation (1) and rearrange them to get: in: α 1 [x o y o , x o z o ,y o z o ]: V Pi =[v i,x v i,y ,v i,x v i,z ,v i,y v i,z ] 1 3 =[1,1,1] 0 3 =[0,0,0] According to γ o Define the unknown vector The vector expression of formula (2) is: in: x t =C t Dt By taking the derivative of equation (2) in time, we get the observation equation of Doppler frequency shift information: in: h i =2+f i o / f i c The vector expression of formula (4) is: in: B t =I M x f =D f Δf+D t Dt Combining equation (2) and equation (4) we get the vector equation under total measurement: in: A 1 =[A t ,A f ] h 1 =[h t ,h f ] B 1 =blkdiag{B t ,B f } ξ=[ξ t ,x f ] Get the unknown vector Solution: in: According to the unknown vector The solution to obtain the initial position and velocity of the underwater dynamic target is: In the formula, t i is the delay measurement information obtained by sensor i, Δt i is a Gaussian distribution with a mean of 0. is the i-th real delay information, t i is the position of sensor i when it emits the detection signal, γ o is an auxiliary variable, is the coefficient matrix of auxiliary variables, x o ,y o , z o Respectively represent the position of the underwater target on the X-axis, Y-axis, and Z-axis, represents the velocity of sensor i, v i,x ,v i,y ,v i,z They are respectively represented as the speed of sensor i on the X-axis, Y-axis, and Z-axis, C t is a diagonal matrix, Δτ is a Gaussian distribution with a mean of 0, and f i o is the true i-th Doppler frequency, f i c is the carrier frequency of the detection signal emitted by sensor i, q i,f is the coefficient matrix of auxiliary variables, I M is the identity matrix of dimension M×M, D f , D t is a diagonal matrix, W 1 is the weight vector, Q 1 is the covariance matrix, is the estimated target position, is the estimated target speed.
Citation Information
Patent Citations
Delay-Doppler domain underwater target differential positioning method with asynchronous clocks
CN114924229A
Cited By
Underwater target motion state evaluation method based on distributed sound barrier system
CN119805464A
Control method, device and equipment of high-precision simple underwater acoustic positioning system
CN120143053A
