A deep-sea dual-base three-dimensional positioning method and system combining multi-angle information

By combining multi-angle information, the target position is solved by combining propagation delay and azimuth information, and through error covariance filtering, the dual solution problem in three-dimensional positioning of dual bases is solved, improving positioning accuracy and avoiding noise interference.

CN118363027BActive Publication Date: 2024-11-08HARBIN ENG UNIV +1
View PDF 7 Cites 0 Cited by

Patent Information

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

AI Technical Summary

Technical Problem

There is a dual solution problem in the three-dimensional positioning of dual bases, making it difficult to distinguish the real target position. Existing solutions such as equipping the sonar or increasing the measuring pitch angle device has complexity and high cost problems.

Method used

By combining multi-angle information, using propagation delay and azimuth information to solve the target position, calculate the positioning error covariance as the judgment threshold, perform the first and second filtering, retain the set of solutions with the smallest distance and perform weighted averages. Output target track.

Benefits of technology

The dual-solving problem is effectively solved, the positioning accuracy is improved, the impact of occasional noise on the positioning results is avoided, and more accurate target positioning is achieved.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118363027B_ABST
    Figure CN118363027B_ABST
Patent Text Reader

Abstract

The present invention discloses a deep-sea dual-base three-dimensional positioning method and system combining multi-angle information, which relates to the field of underwater acoustic positioning technology, in order to solve the problem of difficulty in calculating dual solutions and distinguishing real targets in three-dimensional positioning. The method includes: determining environmental parameters by measurement; inputting the deployment parameters of multi-base base stations; sending signals from the transmitting station, scattering by the target, and obtaining target measurement information from the receiving station; using the combination of the target measurement information to solve the target position to obtain dual solutions; calculating the distance of the target position, and then calculating the positioning error covariance through the measurement error caused by the sonar itself and the spatial position of the target, and using the trace of the positioning error covariance as the decision threshold, judging a group of solutions or multiple groups of solutions with a distance less than the decision threshold and performing secondary filtering, retaining a group of solutions with the smallest distance, taking a weighted average of the retained group of solutions, and finally outputting the target trajectory.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention belongs to the technical field of underwater acoustic positioning, and relates to a dual-base positioning method and system, and in particular to a deep-sea dual-base three-dimensional positioning method and system combining multi-angle information. Background Art

[0002] Bistatic sonar separates the transmitting device from the receiving device, which is an important means to avoid the influence of platform noise and increase the detection distance. The basic method of bistatic three-dimensional positioning is the ellipsoid-sphere-plane intersection positioning method. The sound wave is emitted by the transmitting base station. After being scattered by the target and reaching the receiving base station, the total propagation distance is calculated based on its propagation delay. All points in space with a distance equal to the total propagation distance from the bistatic base form an ellipsoid. The position of the bistatic base is the focus of the ellipsoid, and the target is on the surface of this ellipsoid. The distance between the target and the transmitting base station is calculated based on the propagation time of the transmitting base station's transmission and the target scattering back to the transmitting base station. All points in space with a distance equal to the transmitting base station form a sphere, with the transmitting base station position as the center of the sphere, and the target is on this sphere. Solving the ellipsoid, sphere, and azimuth plane can obtain the target position information. There is only one real target position, but solving it by the above method will result in two solutions.

[0003] In 2005, Sun Zhijie from Northwestern Polytechnical University considered that there were certain limitations in the two-dimensional positioning of targets by dual-base sonar systems. If the target needs to be spatially positioned in practical applications, a three-dimensional positioning method must be used. He discussed four basic methods of three-dimensional positioning. Sun Zhijie pointed out that from the perspective of spatial analytic geometry, there is a solution to three-dimensional positioning of targets using the redundant information of dual / multi-base systems, but generally two depth values ​​are obtained, so there is positioning ambiguity in the vertical direction. Therefore, it is necessary to add an auxiliary elevation angle measurement device to determine the choice of dual solutions based on the size of the elevation angle. In 2009, Wang Cheng from Northwestern Polytechnical University derived the positioning equation of a multi-base sonar system based on distance information on the basis of the positioning method of a dual-base sonar system and studied the error distribution characteristics of the system under different station layouts. In 2013, Shu Hui from Zhejiang University proposed to realize three-dimensional active positioning of targets based on a double helix array. The echo information of the double helix array contains the distance, depth and azimuth information of the target. Since then, Sun Yong and other underwater acoustic technology researchers have focused on improving the positioning accuracy of dual / multi-base sonar systems by improving algorithms, and have successively proposed positioning methods such as the TOL and BOL joint estimation positioning algorithm and the pure distance least squares based positioning method.

[0004] In summary, since the development of dual-base positioning from two-dimensional plane to three-dimensional space, many studies have been carried out to improve positioning algorithms and improve positioning accuracy. However, to solve the dual-solution problem, a method of measuring depth or elevation angle using a sonar alone is usually used to make trade-offs between the dual solutions. The main solutions to the dual-solution problem in dual-base three-dimensional positioning are: first, equip with height-measuring sonar, but the disadvantage is that the measurement process is complicated and the real-time performance is poor; second, add a device to measure the pitch angle, but the disadvantage is that the cost is increased and the measurement process is complicated; third, design an array structure to increase measurement information, but the disadvantage is that it is difficult to implement and deploy, and the above three solutions only screen the obtained targets, without improving positioning accuracy.

[0005] The problems existing in the existing technology are: first, the height-finding sonar requires special equipment and has poor mobility; second, the base station sonar configuration needs to be improved, which is costly and complex to implement; third, the design of the array structure has higher requirements for the positioning accuracy of deployment and movement. Summary of the invention

[0006] The purpose of the present invention is to provide a deep-sea dual-base three-dimensional positioning method, device, system and terminal equipment that combines multi-angle information to solve the technical problem of difficulty in calculating dual solutions and distinguishing real targets in three-dimensional positioning.

[0007] In order to achieve the above object, the present invention provides the following technical solution, a deep-sea bistatic three-dimensional positioning method combining multi-angle information, comprising:

[0008] S1 determines environmental parameters by measurement;

[0009] S2 inputs the deployment parameters of the multi-base station;

[0010] S3: The transmitting station sends a signal, which is scattered by the target, and the receiving station obtains the target measurement information;

[0011] S4 uses the combination of the target measurement information to respectively solve the target position to obtain a dual solution;

[0012] S5 calculates the distance of the target position to be solved, and then calculates the positioning error covariance through the measurement error caused by the sonar itself and the spatial position of the target, and uses the trace of the positioning error covariance as a decision threshold to determine a set of solutions or multiple sets of solutions whose distance is less than the decision threshold;

[0013] S6 performs secondary filtering on multiple groups of solutions whose distances are judged to be less than the decision threshold, retains the group of solutions with the smallest distance, performs weighted average on the retained group of solutions, and finally outputs the target trajectory.

[0014] Optionally, the environmental parameters include sound speed distribution and ocean depth; the deployment parameters include location information and movement trajectory of transmitting stations and receiving stations in a multi-base base station.

[0015] Further, the target measurement information of S3 includes propagation delay 1 from transmitting station to target to receiving station 1, propagation delay 2 from transmitting station to target to receiving station 2, azimuth 1 from target to receiving station 1, and azimuth 2 from target to receiving station 2;

[0016] The S4 uses two measurement information combinations of propagation delay 1, propagation delay 2, azimuth 1 and propagation delay 1, propagation delay 2, azimuth 2 to respectively solve the target position and obtain a dual solution.

[0017] Furthermore, the target position solved by the propagation delay 1, propagation delay 2, and azimuth 1 in S4 is recorded as solution 1 and solution 2, and there must be a true solution between solution 1 and solution 2; the target position solved by the propagation delay 1, propagation delay 2, and azimuth 2 is recorded as solution 3 and solution 4, and there must be a true solution between solution 3 and solution 4.

[0018] Optionally, solving the target position specifically includes:

[0019] Given the coordinates of the transmitting base station (x1, y1, z1), the coordinates of the receiving base station 1 (x2, y2, z2), and the coordinates of the receiving base station 2 (x3, y3, z3), the distances between the target and the transmitting base station and the receiving base station 2 and r 1,3 , the distance between the target and the transmitting base station and the receiving base station 1 and r 1,2 , target-receiving base station 2 azimuth θ; target position (x, y, z) is to be determined,

[0020] The basic equations are obtained as follows:

[0021]

[0022] If yes:

[0023]

[0024] The (x, y, z) obtained in this way are solutions 3 and 4.

[0025] Further, the S5 includes:

[0026] The distances between solution 1 and solution 3, solution 2 and solution 3, solution 1 and solution 4, solution 2 and solution 4 are calculated respectively, and the corresponding target positioning errors are solved respectively, and then the positioning error covariance of the corresponding groups is calculated. The positioning error covariance of solution 1 and solution 3 is:

[0027] P 1,3 =P1(P1+P3) -1 P3=(P1 -1 +P3 -1 ) -1 (twenty one)

[0028] like

[0029]

[0030] Among them, P3 is the positioning error corresponding to solution 3, P1 is the positioning error corresponding to solution 1; p11, p12, p13… are the elements of the corresponding rows and columns in the matrix;

[0031] Then the decision threshold of the group of solution 1 and solution 3 is:

[0032]

[0033] The target position in solution 1 is (x4, y4, z4), and the target position in solution 3 is (x5, y5, z5). The distance between the target positions of solution 1 and solution 3 is:

[0034]

[0035] Finally, compare the distances of the target positions of solutions 1 and 3 with the decision threshold:

[0036] If D1<th1 (24)

[0037] This means that solution 1 and solution 3 are similar, and this group of solutions is filtered for the second time; similarly, the same judgment is made on solution 2 and solution 3, solution 1 and solution 4, and solution 2 and solution 4; among the four groups of solutions, one or more groups of solutions whose distance is less than the corresponding threshold are judged, and one or more groups of solutions whose distance is less than the judgment threshold are filtered for the second time, and the group of solutions with the smallest distance is retained.

[0038] Furthermore, S6 includes:

[0039] The weight is set according to the size of the positioning error. The weight is for the solution with small positioning error, and the weight is heavy. It is known that the target position of solution 1 is X1, and the corresponding positioning error is P1. The target position of solution 3 is X3, and the corresponding positioning error is P3. The covariance of the positioning errors corresponding to solutions 1 and 3 is P 1,3 , then the weighted average result is the three-dimensional positioning result in the three-dimensional space of multi-angle information:

[0040] X=P 1,3 (P1 -1 X1+P2 -1 X3) (25)

[0041] X is the target result, where X = (x, y, z) T The present invention also provides a deep-sea dual-base three-dimensional positioning device combining multi-angle information, comprising:

[0042] A measurement module, used for determining environmental parameters through measurement;

[0043] An input module, used to input deployment parameters of multi-base stations;

[0044] The propagation module is a transmitting station that sends signals, which are scattered by the target, and the receiving station obtains the target measurement information;

[0045] The solution module uses two measurement information combinations of propagation delay 1, propagation delay 2, azimuth 1 and propagation delay 1, propagation delay 2, azimuth 2 to solve the target position respectively, and obtains a double solution;

[0046] The first filtering module is used to calculate the distance between the propagation delay 1, propagation delay 2, azimuth 1 and the target position solved by propagation delay 1, propagation delay 2, azimuth 2, respectively, and then calculate the positioning error covariance through the measurement error caused by the sonar itself and the spatial position of the target, and use the trace of the positioning error covariance as the decision threshold; and judge a group of solutions or multiple groups of solutions whose distance is less than the decision threshold;

[0047] The second filtering module is used to perform secondary filtering on multiple groups of solutions whose distances are less than the decision threshold, and retain a group of solutions with the smallest distance;

[0048] A weighted average module, used for performing weighted average on the set of solutions retained, and setting weights according to the size of the positioning error; the weights are heavier for solutions with smaller positioning errors;

[0049] Output module, used to output target trajectory.

[0050] The present invention also provides a system comprising the deep-sea bistatic three-dimensional positioning device combining multi-angle information.

[0051] The system also includes a multi-base base station and a deep-sea dual-base three-dimensional positioning device that combines multi-angle information. The multi-base base station includes a transmitting base station and two receiving base stations. The transmitting station sends a signal, which is scattered by the target, and the receiving station obtains the target measurement information.

[0052] The deep-sea dual-base three-dimensional positioning device combining multi-angle information is used to output the target trajectory according to the target measurement information.

[0053] The present invention also provides a terminal device, characterized in that the terminal device includes a memory, a processor and a communication interface, the memory stores a computer program, and the processor is configured to run the computer program to execute the steps of the deep-sea dual-base three-dimensional positioning method combining multi-angle information.

[0054] Compared with the prior art, the deep-sea dual-base three-dimensional positioning method combining multi-angle information proposed in the present invention has the following beneficial technical effects:

[0055] (1) The present invention solves the problem of dual-solution targets in traditional dual-base three-dimensional positioning. Traditional three-dimensional positioning algorithms only use a measurement information combination containing one azimuth angle for positioning, and the positioning results have a dual-solution phenomenon, making it difficult to distinguish the true target position. The present invention combines the positioning results of multi-angle information, based on the fact that each dual solution obtained by the measurement information combination must contain a true solution. By analogy with the nearest neighbor idea, the multiple solutions obtained by combining the multi-angle information are mutually judged by distance, which can effectively solve the problem of dual-solution targets in traditional dual-base three-dimensional positioning.

[0056] (2) The present invention improves positioning accuracy and can effectively avoid the influence of occasional noise on positioning results. Traditional methods can only select one of the two solutions by filtering through height or pitch angle information, and cannot judge whether the positioning result is affected by occasional noise. The present invention combines dual-base three-dimensional positioning with multi-angle information to judge the target positioning result obtained by combining measurement information containing information at different angles. After two filterings, the target solution obtained is basically consistent with the target position, and effectively avoids the interference of false solutions on the filtering process and the influence of occasional noise on the positioning result. BRIEF DESCRIPTION OF THE DRAWINGS

[0057] The drawings described herein are used to provide a further understanding of the present invention and constitute a part of the present invention. The exemplary embodiments of the present invention and their descriptions are used to explain the present invention and do not constitute an improper limitation of the present invention. In the drawings:

[0058] Figure 1 This is a flow chart of a deep-sea dual-base three-dimensional positioning method combining multi-angle information of the present invention;

[0059] Figure 2 A schematic diagram comparing the three-dimensional positioning method of the present invention with the three-dimensional positioning method in the prior art;

[0060] Figure 3 It is a three-dimensional multi-angle intersection principle diagram of the present invention;

[0061] Figure 4 It is a two-dimensional multi-angle intersection principle diagram of the present invention;

[0062] Figure 5 This is a schematic diagram of the solution result obtained by using only the measurement information combination 1 in the prior art;

[0063] Figure 6 This is a schematic diagram of the solution result obtained by using only measurement information combination 2 in the prior art;

[0064] Figure 7 This is a schematic diagram of the three-dimensional positioning result without the second filtering in the present invention;

[0065] Figure 8This is a schematic diagram of the three-dimensional positioning result without using the first filtering in the present invention;

[0066] Fig. 9 This is a schematic diagram of the actual target location;

[0067] Fig.10 This is a schematic diagram of the three-dimensional positioning result after being processed by the method of the present invention;

[0068] Fig.11 This is a schematic diagram of the comparison results of positioning errors after being processed by the method of the present invention;

[0069] Fig.12 It is a schematic structural diagram of a deep-sea dual-base three-dimensional positioning device combining multi-angle information according to the present invention;

[0070] Fig.13 A schematic diagram of a terminal device of the present invention. DETAILED DESCRIPTION

[0071] In order to clearly describe the technical solutions of the embodiments of the present invention, in the embodiments of the present invention, words such as "first" and "second" are used to distinguish the same items or similar items with basically the same functions and effects. For example, the first threshold and the second threshold are only used to distinguish different thresholds, and their order is not limited. Those skilled in the art can understand that words such as "first" and "second" do not limit the quantity and execution order, and words such as "first" and "second" do not necessarily limit them to be different.

[0072] It should be noted that, in the present invention, words such as "exemplary" or "for example" are used to indicate examples, illustrations or descriptions. Any embodiment or design described as "exemplary" or "for example" in the present invention should not be interpreted as being more preferred or more advantageous than other embodiments or designs. Specifically, the use of words such as "exemplary" or "for example" is intended to present related concepts in a specific way.

[0073] In the present invention, "at least one" means one or more, and "plurality" means two or more. "And / or" describes the association relationship of associated objects, indicating that three relationships may exist. For example, A and / or B can mean: A exists alone, A and B exist at the same time, and B exists alone, where A and B can be singular or plural. The character " / " generally indicates that the associated objects before and after are in an "or" relationship. "At least one of the following" or similar expressions refers to any combination of these items, including any combination of single or plural items. For example, at least one of a, b or c can mean: a, b, c, the combination of a and b, the combination of a and c, the combination of b and c, or the combination of a, b and c, where a, b, c can be single or multiple.

[0074] Embodiment 1

[0075] Figure 1 This is a flow chart of a deep-sea dual-base three-dimensional positioning method combining multi-angle information of the present invention, comprising the following steps:

[0076] Step 1, determining environmental parameters by measurement; the environmental parameters include sound speed distribution and ocean depth.

[0077] Step 2: input the deployment parameters of the multi-base station; the deployment parameters include the location information and movement trajectory of the transmitting station and the receiving station in the multi-base station.

[0078] Step 3: The transmitting station sends a signal, which is scattered by the target, and the receiving station obtains the target measurement information. The target measurement information includes the propagation delay 1 from the transmitting station to the target to the receiving station 1, the propagation delay 2 from the transmitting station to the target to the receiving station 2, the azimuth 1 from the target to the receiving station 1, and the azimuth 2 from the target to the receiving station 2.

[0079] Step 4, using two measurement information combinations of propagation delay 1, propagation delay 2, azimuth 1 and propagation delay 1, propagation delay 2, azimuth 2 to respectively solve the target position and obtain a dual solution.

[0080] The target position solved by propagation delay 1, propagation delay 2, and azimuth angle 1 in step 4 is recorded as solution 1 and solution 2, and there must be a true solution between solution 1 and solution 2; the target position solved by propagation delay 1, propagation delay 2, and azimuth angle 2 is recorded as solution 3 and solution 4, and there must be a true solution between solution 3 and solution 4.

[0081] In the specific implementation of step 4, taking the solution of combination 2 propagation delay 1, propagation delay 2, and azimuth 2 as an example, the coordinates of the transmitting base station (x1, y1, z1), the coordinates of the receiving base station 1 (x2, y2, z2), and the coordinates of the receiving base station 2 (x3, y3, z3) are known; the distances between the target and the transmitting base station and the receiving base station 2 and r 1,3 , the distance between the target and the transmitting base station and the receiving base station 1 and r 1,2 , target-receiving base station 2 azimuth angle θ; target position (x, y, z) to be determined.

[0082] According to the above definition, the basic equations are as follows:

[0083]

[0084] have:

[0085]

[0086] The (x, y, z) obtained in this way are solutions 3 and 4.

[0087] Step 5, calculate the distance between the propagation delay 1, propagation delay 2, and azimuth 1 in step 4 and the target position solved by propagation delay 1, propagation delay 2, and azimuth 2 respectively, and then calculate the positioning error covariance through the measurement error caused by the sonar itself and the spatial position of the target, and use the trace of the positioning error covariance as the decision threshold; and determine one or more solutions whose distance is less than the decision threshold.

[0088] Among them, step 5 is specifically: respectively calculate the distance between solution 1 and solution 3, solution 2 and solution 3, solution 1 and solution 4, solution 2 and solution 4 and determine a group or multiple groups of solutions whose distance is less than the corresponding threshold, and jump to step 6 for the second filtering.

[0089] In the specific implementation, first, solve the geometric distance between solution 1 and solution 3; then, calculate the positioning error covariance through the measurement error and the target position, and solve the target positioning error estimate; therefore, the positioning error and noise covariance matrix corresponding to solution 1; similarly, calculate the positioning error corresponding to solution 3; then calculate the positioning error covariance of solutions 1 and 3; finally, compare the distance with the trace of the positioning error covariance, that is, the decision threshold; if the distance is less than the decision threshold, it is determined that solutions 1 and 3 are similar, and the solution group is retained; similarly, make the same judgment on solution 2 and solution 3, solution 1 and solution 4, and solution 2 and solution 4; among the four groups of solutions, judge one or more groups of solutions whose distance is less than the corresponding threshold.

[0090] Take solution 1 and solution 3 as examples: the target position in solution 1 is (x4, y4, z4), the target position in solution 3 is (x5, y5, z5), the speed of sound is c, and the time measurement error of the sonar carried by the transmitting station and the receiving station is σ t is 5 microseconds, the angle measurement error σ θ is 1 degree, then the distance measurement error can be obtained from the time measurement error as

[0091] σ r =σ t ×c (3)

[0092] First, find the distance to the target position of solution 1 and solution 3.

[0093]

[0094] Then, the positioning error covariance is calculated by the measurement error and the target position

[0095] Establishing a mathematical model for 3D positioning

[0096] Y=HX+v (5)

[0097] in

[0098] Y=(r 1,2 ,r 1,3 ,θ) T (6)

[0099] X=(x,y,z) T (7)

[0100] Taking the total differential of X and Y we get

[0101] dY=H1dX (8)

[0102] in

[0103] dY=(dr 1,2 ,dr 1,3 ,dθ) Τ (9)

[0104] dX=(dx,dy,dz) Τ (10)

[0105] H1 is the Jacobian matrix

[0106]

[0107] The elements in H1 are

[0108]

[0109]

[0110]

[0111]

[0112]

[0113]

[0114] The target positioning error estimate is

[0115] dX=H1 -1 dY (18)

[0116] Therefore, the positioning error corresponding to solution 1 is

[0117] P1=H1 -1 Q(H1 T ) -1 (19)

[0118] Q is the noise covariance matrix

[0119]

[0120] Similarly, the positioning error corresponding to solution 3 is P3;

[0121] Therefore, the positioning error covariance of solution 1 and solution 3 is:

[0122] P 1,3 =P1(P1+P3) -1 P3=(P1 -1 +P3 -1 ) -1 (twenty one)

[0123] like

[0124]

[0125] Among them, p11, p12, p13… are elements in corresponding rows and columns in the matrix.

[0126] Then the decision threshold of the group of solution 1 and solution 3 is

[0127]

[0128] Finally, compare the distances of the target positions of solutions 1 and 3 with the decision thresholds of solutions 1 and 3:

[0129] If D1<th1(24)

[0130] This means that solution 1 and solution 3 are similar, and this group of solutions is retained for the second filtering in step 6; similarly, the same judgment is made on solution 2, solution 3, solution 1, solution 4, solution 2, solution 4; among the four groups of solutions, one or more groups of solutions whose distance is less than the corresponding threshold are determined.

[0131] Step 6, perform secondary filtering on multiple groups of solutions whose distances are less than the decision threshold, and retain the group of solutions with the smallest distance; perform weighted averaging on the retained group of solutions, and specify weights according to the size of the positioning error; the weights are heavier for solutions with smaller positioning errors.

[0132] At this point, from step 1 to step 6, the three-dimensional positioning of the dual-base target is completed by combining multi-angle information. The multiple groups of target positions solved by multi-angle are mutually judged to obtain a positioning result that is closer to the actual target position.

[0133] Among them, take the weighted average of solution 1 and solution 3 as an example: it is known that the target position of solution 1 is X1, the corresponding positioning error is P1, the target position of solution 3 is X3, the corresponding positioning error is P3, and the covariance of the positioning errors corresponding to solution 1 and solution 3 is P 1,3 , then the weighted average result is the three-dimensional positioning result in the three-dimensional space of multi-angle information:

[0134] X=P 1,3 (P1 -1 X1+P2 -1 X3) (25)

[0135] That is the target outcome.

[0136] The embodiment of the present invention combines multi-angle information to perform three-dimensional positioning of dual-base targets, and mutually judges multiple groups of target positions solved by multiple angles to obtain a positioning result that is closer to the actual target position.

[0137] Figure 2 Schematic diagram for comparing the three-dimensional positioning method of the present invention with the three-dimensional positioning method in the prior art. Figure 2 It can be seen that (1) the prior art adds a height-finding sonar or a pitch-angle-measuring sonar to the dual-solution problem based on the positioning sonar system to determine the true target position. The disadvantage is that the dual solutions can only be screened by the height or elevation information, which increases the cost and is more complicated to implement in practical applications. The method proposed in the present invention only uses multiple groups of target solutions of the dual-base sonar to make mutual judgments, without adding equipment or designing arrays.

[0138] Figure 3 It is a schematic diagram of the three-dimensional multi-angle intersection principle of the present invention; the present invention utilizes the geometric principle that the intersection of the ellipsoid circle and the intersection of the dual solutions at different azimuth angles have different positions, and based on the coincidence of the real target trajectory, sets the distance threshold of the solution for judgment to obtain the real target solution. Figure 4 It is a two-dimensional multi-angle intersection schematic diagram. Figure 3 A two-dimensional multi-angle intersection schematic diagram on an interface slice of a three-dimensional multi-angle intersection schematic diagram.

[0139] (2) The prior art can obtain information such as distance, angle, and height at the same time by designing the array structure, and use the depth or pitch angle to judge the true target position, which can only screen the dual solutions of the target and has no effect on the positioning accuracy, etc., and the special array is difficult to deploy. The present invention uses the error covariance matrix to set the filtering threshold and weighting coefficient, and the two-step filtering realizes the suppression of noise and the screening of dual solutions, thereby realizing the precise positioning of the target.

[0140] Figure 5 This is a schematic diagram of the solution result obtained by using only measurement information combination 1 in the prior art. Figure 6 This is a schematic diagram of the solution result obtained by using only measurement information combination 2 in the prior art. It can be seen that Figure 5 and Figure 6 As shown in the figure, the traditional 3D positioning algorithm only includes one azimuth measurement information combination for positioning, and the positioning result has a double solution phenomenon, making it difficult to distinguish the true target position. The traditional method can only select one of the double solutions by filtering the height or pitch angle information, and it is completely unable to judge whether the positioning result is affected by occasional noise.

[0141] Figure 7The figure is a schematic diagram of the three-dimensional positioning result using only the first filtering in the present invention. The present invention combines dual-base three-dimensional positioning with multi-angle information, determines the target positioning result obtained by combining the measurement information containing different angle information, first filters multiple groups of target solutions, and judges the similarity of two solutions within the positioning error range caused by the measurement error (the error caused by the sonar's own performance), and retains the target solution within this error range. The first filtering can filter out the positioning results whose positioning error suddenly increases due to occasional noise, and can effectively avoid the influence of occasional noise on the positioning results to a certain extent, but it cannot avoid the situation where some false solutions are also relatively similar, and some results of solution 3 and solution 4 will also be retained.

[0142] Figure 8 This is a schematic diagram of the three-dimensional positioning result using only the second filtering in the present invention. It can be seen that the second filtering can filter out the situation where the distance between the false solutions in the double solutions is relatively close by judging the set of solutions with the smallest distance between the two sets of target solutions, but there will be a problem that the influence of occasional noise on the results is difficult to filter out.

[0143] Fig. 9 This is a schematic diagram of the actual target location; Fig.10 The figure is a schematic diagram of the three-dimensional positioning result after processing by the method of the present invention. It can be seen that the present invention combines the positioning results of multi-angle information, based on the fact that each measurement information combination must contain a true solution in the dual solution, and analogy with the nearest neighbor idea, the multiple solutions obtained by combining multi-angle information are mutually judged by distance, which can effectively solve the problem of dual-solution targets in traditional dual-base three-dimensional positioning. Moreover, after two filterings, the target solution obtained is basically consistent with the target position.

[0144] Fig.11 It is a schematic diagram of the comparison results of positioning errors after being processed by the method of the present invention. It can be seen that after two filterings, the interference of false solutions on the filtering process and the influence of occasional noise on the positioning results are effectively avoided, and the positioning accuracy is improved.

[0145] Embodiment 2

[0146] All relevant contents of each step involved in the above method embodiment can be referred to the functional description of the corresponding functional module. Fig.12 , the present application also proposes a deep-sea dual-base three-dimensional positioning device combining multi-angle information, including:

[0147] The measurement module is used to determine environmental parameters through measurement; the environmental parameters include sound speed distribution and ocean depth.

[0148] The input module is used to input the deployment parameters of the multi-base base station; the deployment parameters include the location information and movement trajectory of the transmitting station and the receiving station in the multi-base base station.

[0149] In the propagation module, the transmitting station sends a signal, which is scattered by the target, and the receiving station obtains the target measurement information. The target measurement information includes the propagation delay 1 from the transmitting station to the target to the receiving station 1, the propagation delay 2 from the transmitting station to the target to the receiving station 2, the azimuth 1 from the target to the receiving station 1, and the azimuth 2 from the target to the receiving station 2.

[0150] The solution module uses two measurement information combinations of propagation delay 1, propagation delay 2, azimuth 1 and propagation delay 1, propagation delay 2, azimuth 2 to solve the target position respectively, and obtains a dual solution.

[0151] The first filtering module is used to calculate the distance between the propagation delay 1, propagation delay 2, and azimuth 1 in step 4 and the target position solved by propagation delay 1, propagation delay 2, and azimuth 2 respectively, and then calculate the positioning error covariance through the measurement error caused by the sonar itself and the spatial position of the target and use the trace of the positioning error covariance as the decision threshold; and determine one or more solutions whose distance is less than the decision threshold.

[0152] The second filtering module is used to perform secondary filtering on multiple groups of solutions whose distances are less than the decision threshold, and retain a group of solutions with the smallest distance;

[0153] A weighted average module, used for performing weighted average on the set of solutions retained, and setting weights according to the size of the positioning error; the weights are heavier for solutions with smaller positioning errors;

[0154] Output module, used to output target trajectory.

[0155] The contents of the second embodiment that are the same as those of the first embodiment will not be described repeatedly here.

[0156] Embodiment 3

[0157] This embodiment also provides a terminal device 300, referring to Fig.13 , including a memory, a processor and a communication interface, the memory storing a computer program, and the processor being configured to run the computer program to execute the steps in any one of the above-mentioned embodiments of the deep-sea bi-base three-dimensional positioning method combining multi-angle information.

[0158] like Fig.13As shown, the processor may be a general-purpose central processing unit (CPU), a microprocessor, an application-specific integrated circuit (ASIC), or one or more integrated circuits for controlling the execution of the program of the scheme of the present invention. The communication interface may be one or more. The communication interface may use any transceiver-like device for communicating with other devices or communication networks. The terminal device may also include a communication line. The communication line may include a path for transmitting information between the components.

[0159] Optional, such as Fig.13 As shown, the terminal device may further include a memory. The memory is used to store computer-executable instructions for executing the solution of the present invention, and the execution is controlled by the processor. The processor is used to execute the computer-executable instructions stored in the memory, thereby implementing the method provided by the embodiment of the present invention.

[0160] like Fig.13 As shown, the memory may be a read-only memory (ROM) or other types of static storage devices that can store static information and instructions, a random access memory (RAM) or other types of dynamic storage devices that can store information and instructions, or an electrically erasable programmable read-only memory (EEPROM), a compact disc read-only memory (CD-ROM) or other optical disc storage, optical disc storage (including compressed optical disc, laser disc, optical disc, digital versatile disc, Blu-ray disc, etc.), a magnetic disk storage medium or other magnetic storage device, or any other medium that can be used to carry or store the desired program code in the form of instructions or data structures and can be accessed by a computer, but is not limited thereto. The memory may exist independently and be connected to the processor through a communication line. The memory may also be integrated with the processor.

[0161] Optionally, the computer-executable instructions in the embodiment of the present invention may also be referred to as application program codes, which is not specifically limited in the embodiment of the present invention.

[0162] In a specific implementation, as an example, Fig.13 As shown, the processor may include one or more CPUs, such as Fig.13 CPU0 and CPU1 in.

[0163] In a specific implementation, as an example, Fig.13 As shown, the terminal device may include multiple processors, such as Fig.13 Each of these processors can be a single-core processor or a multi-core processor.

[0164] Although the present invention is described herein in conjunction with various embodiments, in the process of implementing the claimed invention, those skilled in the art may understand and implement other variations of the disclosed embodiments by viewing the drawings, the disclosure, and the appended claims. In the claims, the word "comprising" does not exclude other components or steps, and "one" or "an" does not exclude multiple situations. A single processor or other unit may implement several functions listed in the claims. Certain measures are recorded in different dependent claims, but this does not mean that these measures cannot be combined to produce good results.

[0165] Although the present invention has been described in conjunction with specific features and embodiments thereof, it is apparent that various modifications and combinations may be made thereto without departing from the spirit and scope of the present invention. Accordingly, this specification and the accompanying drawings are merely exemplary illustrations of the present invention as defined by the appended claims and are deemed to cover any and all modifications, variations, combinations or equivalents within the scope of the present invention. Obviously, those skilled in the art may make various modifications and variations to the present invention without departing from the spirit and scope of the present invention. Thus, the present invention is intended to include such modifications and variations if they fall within the scope of the claims of the present invention and their equivalents.

Claims

1. A deep-sea dual-base three-dimensional positioning method combining multi-angle information, characterized in that: include: S1 determines environmental parameters by measurement; S2 inputs the deployment parameters of the multi-base station; S3: The transmitting station sends a signal, which is scattered by the target, and the receiving station obtains the target measurement information; S4 uses the combination of the target measurement information to respectively solve the target position to obtain a dual solution; S5 calculates the distance of the target position to be solved, and then calculates the positioning error covariance through the measurement error caused by the sonar itself and the spatial position of the target, and uses the trace of the positioning error covariance as a decision threshold to determine a set of solutions or multiple sets of solutions whose distance is less than the decision threshold; S6 performs secondary filtering on multiple groups of solutions whose distance is less than the judgment threshold, retains the group of solutions with the smallest distance, performs weighted average on the retained group of solutions, and finally outputs the target trajectory; The target measurement information of S3 includes propagation delay 1 from transmitting station to target to receiving station 1, propagation delay 2 from transmitting station to target to receiving station 2, azimuth 1 from target to receiving station 1, and azimuth 2 from target to receiving station 2; The S4 uses the two measurement information combinations of the propagation delay 1, the propagation delay 2, the azimuth 1 and the propagation delay 1, the propagation delay 2, the azimuth 2 to respectively solve the target position and obtain a dual solution.

2. The deep-sea bistatic three-dimensional positioning method combining multi-angle information according to claim 1, characterized in that: The environmental parameters include sound speed distribution and ocean depth; the deployment parameters include location information and movement trajectory of transmitting stations and receiving stations in a multi-base base station.

3. The deep-sea bistatic three-dimensional positioning method combining multi-angle information according to claim 2, characterized in that: The target position solved by the propagation delay 1, propagation delay 2, and azimuth 1 in S4 is recorded as solution 1 and solution 2, and there must be a true solution between solution 1 and solution 2; the target position solved by the propagation delay 1, propagation delay 2, and azimuth 2 is recorded as solution 3 and solution 4, and there must be a true solution between solution 3 and solution 4.

4. The deep-sea bistatic three-dimensional positioning method combining multi-angle information according to claim 3, characterized in that: The solution to the target position specifically includes: Known transmitting base station coordinates , receive base station 1 coordinates , receiving the coordinates of base station 2 ; The distance between the target and the transmitting base station and the receiving base station 2 and , the distance between the target and the transmitting base station and the receiving base station 1 and , target-receiving base station 2 azimuth ; Target location To be sought, The basic equations are obtained as follows: have: The (x, y, z) obtained in this way are solutions 3 and 4.

5. The deep-sea bistatic three-dimensional positioning method combining multi-angle information according to claim 3, characterized in that S5 include: The distances between solution 1 and solution 3, solution 2 and solution 3, solution 1 and solution 4, solution 2 and solution 4 are calculated respectively, and the corresponding target positioning errors are solved respectively, and then the positioning error covariance of the corresponding groups is calculated. The positioning error covariance of solution 1 and solution 3 is: like in, is the positioning error corresponding to solution 3, P1 is the positioning error corresponding to solution 1; p11, p12, p13… are the elements of the corresponding rows and columns in the matrix; Then the decision threshold of the group of solution 1 and solution 3 is: The target position in solution 1 is , the target position in solution 3 is , then the distances to the target positions of solution 1 and solution 3 are: Finally, compare the distances of the target positions of solutions 1 and 3 with the decision threshold: like This means that solution 1 and solution 3 are similar, and this group of solutions is filtered for the second time; similarly, the same judgment is made on solution 2 and solution 3, solution 1 and solution 4, and solution 2 and solution 4; among the four groups of solutions, one or more groups of solutions whose distance is less than the corresponding threshold are judged, and one or more groups of solutions whose distance is less than the judgment threshold are filtered for the second time, and the group of solutions with the smallest distance is retained.

6. The deep-sea bistatic three-dimensional positioning method combining multi-angle information according to claim 5, characterized in that S6 include: The weight is set according to the size of the positioning error. The weight is heavy for the solution with small positioning error. It is known that the target position of solution 1 is X1, the corresponding positioning error is P1, the target position of solution 3 is X3, the corresponding positioning error is P3, and the positioning error covariance of solution 1 and solution 3 is P 1,3 , then the weighted average result is the three-dimensional positioning result in the three-dimensional space of multi-angle information: X is the target result, where .

7. A deep-sea dual-base three-dimensional positioning device combining multi-angle information, characterized in that: include: A measurement module, used for determining environmental parameters through measurement; An input module, used to input deployment parameters of multi-base stations; The propagation module is a transmitting station that sends signals, which are scattered by the target, and the receiving station obtains the target measurement information; The target measurement information includes propagation delay 1 from the transmitting station to the target to the receiving station 1, propagation delay 2 from the transmitting station to the target to the receiving station 2, azimuth 1 from the target to the receiving station 1, and azimuth 2 from the target to the receiving station 2; A solution module, using the propagation delay 1, propagation delay 2, azimuth 1 and the propagation delay 1, propagation delay 2, azimuth 2 two measurement information combinations to solve the target position respectively, and obtain a dual solution; The first filtering module is used to calculate the distance between the propagation delay 1, propagation delay 2, and azimuth 1 and the target position solved by the propagation delay 1, propagation delay 2, and azimuth 2, respectively, and then calculate the positioning error covariance through the measurement error caused by the sonar itself and the spatial position of the target, and use the trace of the positioning error covariance as the decision threshold; and judge a group of solutions or multiple groups of solutions whose distance is less than the decision threshold; The second filtering module is used to perform secondary filtering on multiple groups of solutions whose distances are less than the decision threshold, and retain a group of solutions with the smallest distance; A weighted average module, used for performing weighted average on the set of solutions retained, and setting weights according to the size of the positioning error; the weights are heavier for solutions with smaller positioning errors; Output module, used to output target trajectory.

8. A system comprising the deep-sea bistatic three-dimensional positioning device combining multi-angle information as claimed in claim 7, characterized in that: The system also includes a multi-base base station and a deep-sea dual-base three-dimensional positioning device that combines multi-angle information, wherein the multi-base base station includes a transmitting base station and two receiving base stations; The signal is sent by the transmitting station, scattered by the target, and the receiving station obtains the target measurement information; The deep-sea dual-base three-dimensional positioning device combining multi-angle information is used to output the target trajectory according to the target measurement information.

9. A terminal device, characterized in that: The terminal device includes a memory, a processor and a communication interface, the memory stores a computer program, and the processor is configured to run the computer program to execute the deep-sea bi-base three-dimensional positioning method combining multi-angle information as described in any one of claims 1-6.

Citation Information

Patent Citations

  • Simulated annealing locating method for multi-base sonar configuration mode

    CN103558602A

  • Target association method based on multi-base MIMO radar

    CN105093201A

  • Multi-station hybrid tracking method for external radiation source radar

    CN108562893A

  • Double-base positioning method under variable sound velocity based on grid matching

    CN115407340A

  • Continuous transmission synthetic aperture sonar

    EP0199571A1