Multi-unmanned platform track fusion and mutual verification method
By using a comprehensive track formation algorithm of multi-point positioning and track data correlation judgment in the unmanned platform navigation system, the problem of interference or deception of the navigation system in the multi-unmanned platform environment is solved, and the precise positioning of the track is achieved and improve safety.
Patent Information
- Application Number
- CN202411165413.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-23
- Publication Date
- 2024-12-03
AI Technical Summary
The prior art is difficult to effectively prevent unmanned platform navigation systems from being interfered with or tricked, resulting in inaccurate tracking, especially in multi-unmanned platform environments, how to integrate and calibrate track information to improve safety and accuracy is a challenge.
By building a multi-unmanned platform navigation system, using the ad hoc network communication module and the ranging module to transmit position information and ranging information in real time, combined with GPS or Beidou navigation and positioning module, a comprehensive track formation algorithm for multi-point positioning is used to calculate the target unmanned The real position of the platform and determine whether it is disturbed or deceptive through the correlation of the track data, and perform track fusion and mutual verification processing to achieve precise positioning.
It improves the track accuracy and safety of the unmanned platform, enhances anti-interference ability, avoids navigation deception, reduces unnecessary losses, and makes the unmanned platform more robust.
Smart Images

Figure CN119064968A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of unmanned aerial vehicles, and in particular to a method for merging and mutually verifying the tracks of multiple unmanned platforms. Background Art
[0002] At present, unmanned platform applications are becoming more and more popular, such as drones, unmanned vehicles, and unmanned boats. There are many applications on the market that need to appear in the form of groups and are used in forests, mountains, plateaus, cities and other areas. With the rapid development of anti-unmanned technology, unmanned platforms are also faced with how to prevent navigation spoofing. In the existing technology, the research focus is mostly on the anti-interference communication waveform design of a single platform or the anti-spoofing technology of the navigation equipment itself, which puts high demands on the anti-interference of navigation and positioning equipment. Assuming that a member's navigation equipment has been interfered with or deceived, it is necessary to consider how to obtain correct track information and perform correct flight. In addition, the track generated by its own sensor and the track generated by members in the network should be comprehensively considered, and how to fuse them when they are highly correlated, so as to serve as a basis for mutual track verification. Summary of the invention
[0003] The purpose of the present invention is to overcome the shortcomings of the prior art and provide a method for fusion and mutual verification of multiple unmanned platform tracks to improve the safety and track accuracy of the unmanned platforms.
[0004] The objective of the present invention is achieved through the following technical solutions:
[0005] A method for fusion and mutual verification of tracks of multiple unmanned platforms, the method comprising:
[0006] Step S1, constructing a multi-unmanned platform navigation system, the system includes multiple unmanned platforms, unmanned platform payload ad hoc network communication module, ranging module, GPS or Beidou navigation and positioning module, each unmanned platform can transmit position information and ranging information parameters in real time through the ad hoc network communication module;
[0007] Step S2: any target unmanned platform in the system generates a real track based on the positioning data obtained by its own GPS or Beidou navigation and positioning module;
[0008] Step S3: any target unmanned platform in the system obtains the positioning coordinates of other unmanned platforms and the distance measurement value with any target unmanned platform through the self-organizing network communication module, calculates the real position of the target unmanned platform through the comprehensive track formation algorithm based on multi-point positioning, and forms a comprehensive track within a period of time;
[0009] Step S4, fusing and mutually verifying the real track and the integrated track, and judging whether the navigation system of the target unmanned platform is interfered or deceived according to the correlation between the real track and the integrated track;
[0010] Step S5: All unmanned platforms in the system estimate the positions of known accurate points and perform position calibration through a comprehensive track formation algorithm based on multi-point positioning.
[0011] Furthermore, the step S3 specifically includes:
[0012] The approximate positions of the target unmanned platform T and other unmanned platforms A, B, and C in the system in geodetic coordinates are expressed as follows: A(x1,y1,z1), B(x2,y2,z2), C(x3,y3,z3); the distance measurement values of the target unmanned platform T and the other unmanned platforms A, B, and C obtained by the ranging module are ρ1, ρ2, and ρ3 respectively;
[0013] Unmanned platforms A, B, and C are accurately positioned through baseline adjustment. The distance measurement module gives the distance between the target unmanned platform T and unmanned platforms A, B, and C at this time as:
[0014] Assume the real coordinates of the target unmanned platform T are: (x u ,y u ,z u ), then:
[0015]
[0016] where Δx u , Δy u , Δz u are the position positioning errors of the target unmanned platform T, j=1, 2, 3 represent unmanned platforms A, B, C;
[0017] Expand according to the Talyer formula:
[0018]
[0019] make Then we have:
[0020]
[0021] make Then ΔX=H -1 Δρ;
[0022] Calculate the real coordinates of the target unmanned platform T as:
[0023] According to the definition of the antenna coordinate system, the real coordinates of the target unmanned platform T are converted into azimuth angle α and pitch angle β:
[0024]
[0025] Thus, the real position of the unmanned platform target is obtained, and a comprehensive track is formed over a period of time.
[0026] Furthermore, the step S4 specifically includes:
[0027] Step S401, converting the real track and the comprehensive track data according to the strategy, so that the track metadata flow in the system itself is completely consistent in format;
[0028] Step S402: Calculate the correlation coefficient between the real track and the comprehensive track data, and compare it with a preset correlation coefficient threshold, and verify the positions of the target unmanned platform and other unmanned platforms by judging the correlation between the real track and the comprehensive track data;
[0029] Step S403: If the tracks are relevant, the target unmanned platform starts track fusion processing; if they are not relevant, the integrated tracks transmitted by other unmanned platforms in the system are given priority;
[0030] Step S404: The system calls the upload service according to the distribution strategy to distribute the track fusion data to each unmanned platform.
[0031] Furthermore, the step S401 specifically includes:
[0032] Data cleaning: Verify the key elements of the track data, including checking unknown data, metadata format errors, abnormal reported data value ranges, and key element loss and integrity. Analyze the data content of real-time access, check the rationality of the data fields, and clean and delete erroneous data and outlier data.
[0033] Data conversion: Analyze the received situation data and convert the data content into numerical values according to the data standard specifications, including standard system conversion, unit conversion, and coordinate conversion;
[0034] Data completion: Verify the integrity of all fields according to the element set required by the data type, and complete the element information with incomplete values through calculation, query and extraction.
[0035] Furthermore, the calculation of the correlation coefficient between the real track and the comprehensive track data specifically includes:
[0036] For the target unmanned platform, the comprehensive track data is expressed as: m(x i ,y i ),i=1,2...N, the real track data is expressed as: n(x j ,y j ),j=1,2...N, calculate the correlation coefficient ρ of two sets of data mn :
[0037]
[0038] Where Cov(m,n) is the covariance of m and n, and D(m) and D(n) are the variances of m and n respectively.
[0039] Furthermore, the mutual verification of the positions of the target unmanned platform and other unmanned platforms by judging the correlation between the real track and the comprehensive track data specifically includes:
[0040] If the calculated correlation coefficient is greater than the preset correlation coefficient threshold, it indicates that the real track data and the integrated track data are well correlated, the two positions are mutually verified, and the position is accurate;
[0041] If the calculated correlation coefficient is smaller than a preset correlation coefficient threshold, it indicates that the real track and the integrated track data are poorly correlated, the position is not accurate enough, and the navigation system position information may be interfered with or deceived.
[0042] Furthermore, the track fusion processing specifically includes:
[0043] The real track and the comprehensive track data are calibrated in space and time to achieve temporal and spatial consistency. The comprehensive track data formed by the other unmanned platforms in the network at the same sampling time in the same coordinate system and the real track data formed by the target unmanned platform are comprehensively associated, and the associated four-dimensional position information is fused. The multiple positions of the target unmanned platform at the same time are fused to obtain the unique position of the target unmanned platform, thereby achieving precise positioning of the target unmanned platform.
[0044] Furthermore, the distance measurement module, GPS or Beidou navigation and positioning module of the unmanned platform communicate serially with the ad hoc network communication module through an RS-232 standard interface.
[0045] The beneficial effects of the present invention are:
[0046] 1) The present invention provides a comprehensive track formation algorithm based on multi-point positioning to obtain the real position of the target unmanned platform, so that a comprehensive track can be formed within a period of time; by calculating the correlation between the comprehensive track generated by the positioning of other network members and the real track of the unmanned platform equipment itself, the correlation coefficient is used as the basis for mutual verification of the two sets of track data.
[0047] 2) Based on confirming the correlation between the two track data, the present invention performs track fusion processing to obtain the precise positioning of the target unmanned platform; in addition, the unmanned platform members used for multi-point positioning can adjust the baseline as needed to adapt to the optimal positioning geometry layout diagram, that is, in multi-point positioning, the basic conditions for solving the equation are met.
[0048] 3) The track fusion and mutual verification method provided in the embodiment of the present invention can be applied to single-type or mixed-type multi-target networks of unmanned platforms including unmanned boats, unmanned vehicles, and unmanned aerial vehicles. It can solve the anti-interference ability of multiple unmanned platforms or swarms, improve the accuracy of track fusion, avoid navigation deception of an unmanned platform member in the network, etc., reduce unnecessary losses, and make the unmanned platform members more robust. BRIEF DESCRIPTION OF THE DRAWINGS
[0049] Figure 1 A schematic diagram of the composition and communication of a multi-unmanned platform navigation system provided by an embodiment of the present invention;
[0050] Figure 2 A schematic diagram of an unmanned platform scenario provided by an embodiment of the present invention;
[0051] Figure 3 A data fusion processing flow chart provided for an embodiment of the present invention;
[0052] Figure 4 A data mutual verification processing flow chart provided for an embodiment of the present invention. DETAILED DESCRIPTION
[0053] The technical solution of the present invention will be clearly and completely described below in conjunction with the embodiments. Obviously, the described embodiments are only part of the embodiments of the present invention, rather than all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those skilled in the art without creative work are within the scope of protection of the present invention.
[0054] See also Figure 1-Figure 4 , the present invention provides a technical solution:
[0055] A method for fusion and mutual verification of tracks of multiple unmanned platforms, the method comprising:
[0056] Step S1, constructing a multi-unmanned platform navigation system, the system includes multiple unmanned platforms, unmanned platform payload ad hoc network communication module, ranging module, GPS or Beidou navigation and positioning module, each unmanned platform can transmit position information and ranging information parameters in real time through the ad hoc network communication module;
[0057] The unmanned platform's ranging module, GPS or Beidou navigation and positioning module communicate with the ad hoc network communication module in serial communication via the RS-232 standard interface. The multi-unmanned platform navigation system includes multiple unmanned platforms (generally ≥4), and mainly transmits the location information and ranging information parameters to each unmanned platform in real time through the ad hoc network module, such as Figure 1 shown.
[0058] Step S2: any target unmanned platform in the system generates a real track based on the positioning data obtained by its own GPS or Beidou navigation and positioning module;
[0059] Step S3: any target unmanned platform in the system obtains the positioning coordinates of other unmanned platforms and the distance measurement value with any target unmanned platform through the self-organizing network communication module, calculates the real position of the target unmanned platform through the comprehensive track formation algorithm based on multi-point positioning, and forms a comprehensive track within a period of time;
[0060] Schematic diagram of unmanned platform scene Figure 2 As shown, including the target unmanned platform T and the remaining unmanned platforms A, B, and C, step S3 specifically includes:
[0061] The approximate positions of the target unmanned platform T and other unmanned platforms A, B, and C in the system in geodetic coordinates are expressed as follows: A(x1,y1,z1), B(x2,y2,z2), C(x3,y3,z3); the distance measurement values of the target unmanned platform T and the other unmanned platforms A, B, and C obtained by the ranging module are ρ1, ρ2, and ρ3 respectively;
[0062] Unmanned platforms A, B, and C are accurately positioned through baseline adjustment. The distance measurement module gives the distance between the target unmanned platform T and unmanned platforms A, B, and C at this time as:
[0063] Assume the real coordinates of the target unmanned platform T are: (x u ,y u ,z u ), then:
[0064]
[0065] where Δx u , Δy u , Δz u are the position positioning errors of the target unmanned platform T, j=1, 2, 3 represent the unmanned platforms A, B, and C;
[0066] Expand according to the Talyer formula:
[0067]
[0068] make Then we have:
[0069]
[0070] make Then ΔX=H -1 Δρ;
[0071] Calculate the real coordinates of the target unmanned platform T as:
[0072] According to the definition of the antenna coordinate system, the real coordinates of the target unmanned platform T can be converted into azimuth angle α and pitch angle β:
[0073]
[0074] Thus, the real position of the unmanned platform target is obtained, and a comprehensive track is formed over a period of time.
[0075] In subsequent work, the integrated track formation algorithm based on multi-point positioning in step S3 can be combined with multiple iteration techniques and prediction algorithms such as Kalman filtering to improve positioning accuracy.
[0076] Step S4, fusing and mutually verifying the real track and the comprehensive track, and judging whether the navigation system of the target unmanned platform is interfered with or deceived according to the correlation between the real track and the comprehensive track; fusing and mutually verifying the sensor track of a member of the unmanned platform and the comprehensive track formed by the network members for a certain member, can solve the erroneous track formed to a certain extent after the GPS of a certain member fails, and prevent being deceived to the area designated by the other party.
[0077] like Figure 3 and Figure 4 As shown, step S4 specifically includes:
[0078] Step S401: converting the real track and the comprehensive track data according to the strategy so that the track metadata flow in the system itself is completely consistent in format; in a specific embodiment, step S401 includes:
[0079] Data cleaning: Verify the key elements of the track data, including checking unknown data, metadata format errors, abnormal reported data value ranges, and key element loss and integrity. Analyze the real-time access data content, check the rationality of the data fields, and clean and delete erroneous data and outlier data; for example: incomplete data, erroneous data, outlier data, and data with garbled formats that cannot be parsed.
[0080] Data conversion: Analyze the received situation data and convert the data content into numerical values according to the data standard specifications, including standard system conversion, unit conversion, and coordinate conversion;
[0081] Data completion: Verify the integrity of all fields according to the element set required by the data type, and complete the element information with incomplete values through calculation, query and extraction.
[0082] Step S402: Calculate the correlation coefficient between the real track and the comprehensive track data, and compare it with a preset correlation coefficient threshold, and verify the positions of the target unmanned platform and other unmanned platforms by judging the correlation between the real track and the comprehensive track data;
[0083] Furthermore, the calculation of the correlation coefficient between the real track and the comprehensive track data specifically includes:
[0084] For the target unmanned platform, the comprehensive track data is expressed as: m(x i ,y i ),i=1,2...N, the real track data is expressed as: n(x j ,y j ),j=1,2...N, calculate the correlation coefficient ρ of two sets of data mn :
[0085]
[0086] Where Cov(m,n) is the covariance of m and n, and D(m) and D(n) are the variances of m and n respectively.
[0087] The correlation coefficient is calculated by the product difference method, which is based on the deviation of the two variables from their respective mean values. The correlation between the two variables is reflected by multiplying the two deviations. It is used to measure the similarity between the two sets of data and reflect the strength and direction of the linear relationship between the two variables.
[0088] The mutual verification of the positions of the target unmanned platform and other unmanned platforms by judging the correlation between the real track and the comprehensive track data specifically includes:
[0089] If the calculated correlation coefficient is greater than the preset correlation coefficient threshold, it indicates that the real track data and the integrated track data are well correlated, the two positions are mutually verified, and the position is accurate;
[0090] If the calculated correlation coefficient is smaller than a preset correlation coefficient threshold, it indicates that the real track and the integrated track data are poorly correlated, the position is not accurate enough, and the navigation system position information may be interfered with or deceived.
[0091] Among them, the correlation coefficient threshold is preset according to engineering experience, can be flexibly determined according to the specific usage environment, and supports flexible adjustment.
[0092] Step S403: If the tracks are relevant, the target unmanned platform starts track fusion processing; if they are not relevant, the integrated tracks transmitted by other unmanned platforms in the system are given priority;
[0093] Furthermore, the track fusion processing specifically includes:
[0094] The real track and the comprehensive track data are calibrated in space and time to achieve temporal and spatial consistency. The comprehensive track data formed by the other unmanned platforms in the network at the same sampling time in the same coordinate system and the real track data formed by the target unmanned platform are comprehensively associated, and the associated four-dimensional position information is fused. The multiple positions of the target unmanned platform at the same time are fused to obtain the unique position of the target unmanned platform, thereby achieving precise positioning of the target unmanned platform.
[0095] Step S404: The system calls the upload service according to the distribution strategy to distribute the track fusion data to each unmanned platform.
[0096] The unmanned platform within the system also supports access to data display from multiple data sources, and provides a variety of data report analysis and presentations, including track point presentation, comprehensive track presentation, etc.
[0097] Step S5: All unmanned platforms in the system estimate the positions of known accurate points through the comprehensive track formation algorithm based on multi-point positioning and perform position calibration. In order to verify the accuracy of the multi-point positioning algorithm, the positions of known accurate points can be used to verify the algorithm. The positions of known accurate points refer to those that are known in advance through other means or intelligence information.
[0098] The present invention designs a comprehensive track formation algorithm based on multi-point positioning to obtain the real position of the target unmanned platform, so that a comprehensive track can be formed within a period of time; by calculating the correlation between the comprehensive track generated by the positioning of other members in the network and the real track of the unmanned platform equipment itself, the correlation coefficient is used as a basis for mutual verification of the two sets of track data; on the basis of confirming the correlation of the two track data, the track fusion processing is performed to obtain the precise positioning of the target unmanned platform; in addition, the unmanned platform members used for multi-point positioning can adjust the baseline as needed to adapt to the optimal positioning geometric layout diagram, that is, when multi-point positioning is performed, the basic conditions for solving the equation are met; the track fusion and mutual verification method provided by the embodiment of the present invention can be applicable to single-type or mixed-type multi-target networks including unmanned boats, unmanned vehicles, unmanned aerial vehicles, etc., which can solve the anti-interference ability of multiple unmanned platforms or swarms, improve the accuracy of track fusion, avoid navigation deception of a certain unmanned platform member in the network, etc., can reduce unnecessary losses, and the unmanned platform members are more robust and can produce greater effects.
[0099] The above is only a preferred embodiment of the present invention. It should be understood that the present invention is not limited to the form disclosed herein, and should not be regarded as excluding other embodiments, but can be used in various other combinations, modifications and environments, and can be modified within the scope of the concept described herein through the above teachings or the technology or knowledge of the relevant field. The changes and modifications made by those skilled in the art shall not deviate from the spirit and scope of the present invention, and shall be within the scope of protection of the claims attached to the present invention.
Claims
1. A method for fusion and mutual verification of multiple unmanned platform tracks, characterized in that: The method comprises: Step S1, constructing a multi-unmanned platform navigation system, the system includes multiple unmanned platforms, unmanned platform payload ad hoc network communication module, ranging module, GPS or Beidou navigation and positioning module, each unmanned platform can transmit position information and ranging information parameters in real time through the ad hoc network communication module; Step S2: any target unmanned platform in the system generates a real track based on the positioning data obtained by its own GPS or Beidou navigation and positioning module; Step S3: any target unmanned platform in the system obtains the positioning coordinates of other unmanned platforms and the distance measurement value with any target unmanned platform through the self-organizing network communication module, calculates the real position of the target unmanned platform through the comprehensive track formation algorithm based on multi-point positioning, and forms a comprehensive track within a period of time; Step S4, fusing and mutually verifying the real track and the integrated track, and judging whether the navigation system of the target unmanned platform is interfered or deceived according to the correlation between the real track and the integrated track; Step S5: All unmanned platforms in the system estimate the positions of known accurate points and perform position calibration through a comprehensive track formation algorithm based on multi-point positioning.
2. A method for fusion and mutual verification of multiple unmanned platform tracks according to claim 1, characterized in that: The step S3 specifically includes: The approximate positions of the target unmanned platform T and other unmanned platforms A, B, and C in the system in geodetic coordinates are expressed as follows: A(x1,y1,z1), B(x2,y2,z2), C(x3,y3,z3); the distance measurement values of the target unmanned platform T and the other unmanned platforms A, B, and C obtained by the ranging module are ρ1, ρ2, and ρ3 respectively; Unmanned platforms A, B, and C are accurately positioned through baseline adjustment. The distance measurement module gives the distance between the target unmanned platform T and unmanned platforms A, B, and C at this time as: Assume the real coordinates of the target unmanned platform T are: (x u ,y u ,z u ), then: where Δx u , Δy u , Δz u are the position positioning errors of the target unmanned platform T, j=1, 2, 3 represent unmanned platforms A, B, C; Expand according to the Talyer formula: make Then we have: make Then ΔX=H -1 Δρ; Calculate the real coordinates of the target unmanned platform T as: According to the definition of the antenna coordinate system, the real coordinates of the target unmanned platform T are converted into azimuth angle α and pitch angle β: Thus, the real position of the unmanned platform target is obtained, and a comprehensive track is formed over a period of time.
3. A method for fusion and mutual verification of multiple unmanned platform tracks according to claim 1, characterized in that: The step S4 specifically includes: Step S401, converting the real track and the comprehensive track data according to the strategy, so that the track metadata flow in the system itself is completely consistent in format; Step S402: Calculate the correlation coefficient between the real track and the comprehensive track data, and compare it with a preset correlation coefficient threshold, and verify the positions of the target unmanned platform and other unmanned platforms by judging the correlation between the real track and the comprehensive track data; Step S403: If the tracks are relevant, the target unmanned platform starts track fusion processing; if they are not relevant, the integrated tracks transmitted by other unmanned platforms in the system are given priority; Step S404: The system calls the upload service according to the distribution strategy to distribute the track fusion data to each unmanned platform.
4. A method for fusion and mutual verification of multiple unmanned platform tracks according to claim 3, characterized in that: The step S401 specifically includes: Data cleaning: Verify the key elements of the track data, including checking unknown data, metadata format errors, abnormal reported data value ranges, and key element loss and integrity. Analyze the data content of real-time access, check the rationality of the data fields, and clean and delete erroneous data and outlier data. Data conversion: Analyze the received situation data and convert the data content into numerical values according to the data standard specifications, including standard system conversion, unit conversion, and coordinate conversion; Data completion: Verify the integrity of all fields according to the element set required by the data type, and complete the element information with incomplete values through calculation, query and extraction.
5. The method for fusion and mutual verification of multiple unmanned platform tracks according to claim 3 is characterized by: The calculation of the correlation coefficient between the real track and the comprehensive track data specifically includes: For the target unmanned platform, the comprehensive track data is expressed as: m(x i ,y i ),i=1,2...N, the real track data is expressed as: n(x j ,y j ),j=1,2...N, calculate the correlation coefficient ρ of two sets of data mn : Where Cov(m,n) is the covariance of m and n, and D(m) and D(n) are the variances of m and n respectively.
6. A method for fusion and mutual verification of multiple unmanned platform tracks according to claim 5, characterized in that: The mutual verification of the positions of the target unmanned platform and other unmanned platforms by judging the correlation between the real track and the comprehensive track data specifically includes: If the calculated correlation coefficient is greater than the preset correlation coefficient threshold, it indicates that the real track data and the integrated track data are well correlated, the two positions are mutually verified, and the position is accurate; If the calculated correlation coefficient is smaller than a preset correlation coefficient threshold, it indicates that the real track and the integrated track data are poorly correlated, the position is not accurate enough, and the navigation system position information may be interfered with or deceived.
7. The method for fusion and mutual verification of multiple unmanned platform tracks according to claim 3 is characterized by: The track fusion processing specifically includes: The real track and the comprehensive track data are calibrated in space and time to achieve temporal and spatial consistency. The comprehensive track data formed by the other unmanned platforms in the network at the same sampling time in the same coordinate system and the real track data formed by the target unmanned platform are comprehensively associated, and the associated four-dimensional position information is fused. The multiple positions of the target unmanned platform at the same time are fused to obtain the unique position of the target unmanned platform, thereby achieving precise positioning of the target unmanned platform.
8. The method for fusion and mutual verification of multiple unmanned platform tracks according to claim 1, characterized in that: The distance measurement module, GPS or Beidou navigation and positioning module of the unmanned platform communicate serially with the ad hoc network communication module through the RS-232 standard interface.
