A collaborative positioning method for low-cost heterogeneous unmanned aerial vehicle formation with a single leader

By adopting the combination of data link communication and particle swarm algorithm in the unmanned aerial vehicle formation, the problem of coordinated positioning of low-cost heterogeneous formations is solved, and efficient and low-cost unmanned aerial vehicle positioning in the GPS denial environment is achieved, which improves the Comprehensive combat effectiveness of formations.

CN114727218BActive Publication Date: 2024-11-05SANHANG UNMANNED SYSTEM TECHNOLOGY (YANTAI) CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202210200276.9
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-03-02
Publication Date
2024-11-05
Estimated Expiration
2042-03-02

AI Technical Summary

Technical Problem

The existing technology is difficult to achieve low-cost coordinated positioning of heterogeneous unmanned aircraft formations. Especially in the battlefield environment where GPS denies or degradation, the traditional inertial navigation system has a large error, which makes it difficult to take into account the accuracy and cost of coordinated positioning of unmanned aircraft formations. .

Method used

Using a leader-following architecture based on data link communication, the position of low-cost unmanned aircraft in the formation is solved by constructing a nonlinear system of equations between unmanned aircraft and combining the particle swarm method of inertial navigation information to achieve coordinated positioning.

Benefits of technology

This method can ensure or improve navigation performance while reducing costs, and provide efficient low-cost unmanned aircraft formation collaborative positioning. It is suitable for a variety of collaborative tasks and improves the cost-effectiveness of the formation.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN114727218B_ABST
    Figure CN114727218B_ABST
Patent Text Reader

Abstract

Aiming at the low-cost heterogeneous formation collaborative positioning technology, which is not well studied in theory at present, the present invention discloses a single-leader heterogeneous low-cost UAV formation collaborative positioning method. The method first constructs a data link communication relationship under the leader-follower architecture, and on this basis, constructs a nonlinear equation group according to the relative distance between the UAVs measured by the data link, and uses a particle swarm method combined with inertial navigation information to solve the position of the low-cost UAV in the formation. The collaborative positioning information solved by this method can be applied to various types of collaborative tasks, with good applicability. The solution speed and accuracy can be improved by improving the search method, and it is easy to meet the needs of various centralized collaborative tasks.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to a single-leader heterogeneous low-cost unmanned aerial vehicle formation collaborative positioning method. Background Art

[0002] Traditional single-soldier combat is constrained by multiple factors in an increasingly complex confrontation environment, making it difficult to achieve successful penetration. Collaborative combat that forms complementary functions and shares resources through networking is widely valued for its group comprehensive combat effectiveness. Compared with high-performance unmanned aerial vehicles, which will suffer the same loss as the others, the coordinated formation of unmanned aerial vehicles can achieve multiple insurances, enriching the combat style while providing more possibilities for successful penetration.

[0003] However, although formation operations can improve comprehensive combat effectiveness and increase mission success rates, economic losses will also increase. Considering production capacity and cost, it is crucial to reduce the cost of unmanned aerial vehicles. The seeker, as the "eye" of the unmanned aerial vehicle, can determine the relative relationship between itself and the target, and directly determine the target capture in the terminal guidance stage. On the other hand, the high cost of the seeker accounts for 1 / 3 of the total aircraft cost. Therefore, reducing the cost of the seeker is an important link in the coordinated improvement of the cost-effectiveness of unmanned aerial vehicle formations.

[0004] On the other hand, battlefield environments with GPS denial or degradation place higher demands on the performance of the UAV's navigation and guidance systems. Although traditional inertial navigation systems have the advantages of low cost and high autonomy, their errors are relatively large. Therefore, how to reduce costs while ensuring or even improving performance has put the low-cost development of UAV formation coordination into a dilemma.

[0005] At present, there are few reports on the theoretical research results of low-cost heterogeneous unmanned aerial vehicle formation collaborative positioning, which has seriously affected the low cost of unmanned aerial vehicle formation coordination. How to use data link communication between unmanned aerial vehicles to achieve low-cost unmanned aerial vehicle collaborative positioning in heterogeneous formations urgently needs a theoretical breakthrough. Therefore, the present invention proposes a single-leader heterogeneous low-cost unmanned aerial vehicle formation collaborative positioning method. Summary of the invention

[0006] In view of the low-cost heterogeneous formation collaborative positioning technology, which is not yet fully studied theoretically, the present invention provides a heterogeneous formation collaborative positioning method based on data link communication under the leader-follower communication architecture. The method first constructs the data link communication relationship under the leader-follower architecture, and on this basis, constructs a nonlinear equation group according to the relative distance between unmanned aerial vehicles measured by the data link, and uses the particle swarm method combined with inertial navigation information to solve the position of the low-cost unmanned aerial vehicle in the formation. The collaborative positioning information solved by this method can be applied to various types of collaborative tasks, and has good applicability.

[0007] The present invention is described in detail according to the following design steps.

[0008] Step 1: Build a single-leader low-cost heterogeneous UAV formation data link communication network

[0009] High-performance leader M0 real-time update accurate position coordinates (x 0 ,y 0 , z 0 ).

[0010] The seven follower aircraft equipped with low-cost inertial navigation systems are denoted as M i (i=1,2,...,7), the corresponding real coordinate position is unknown and is recorded as (x i ,y i , z i ). The upper bound of the assembly error of low-cost unmanned aerial vehicles is E m The inertial navigation system can achieve its own rough positioning, denoted as

[0011] The data link communication network structure is as follows Figure 1 As shown in the figure. The single leader ensures connectivity with all the following aircraft in the formation, and the seven formation-following unmanned aerial vehicles are guaranteed to be undirected and fully connected, that is, the distance between all aircraft in the unmanned aerial vehicle formation can be obtained through data link ranging and transmitted to the leader for calculation and processing. The distance between aircraft obtained by data link measurement is Where R ij =R ji .

[0012] Step 2: Construct a set of equations for cooperative positioning of a single-leader low-cost heterogeneous UAV formation

[0013] First, let X = (x 1 , x 2 , ..., x 7 ,y 1 , ..., y 7 , z 1 , ..., z 7 ), the nonlinear vector of cooperative positioning of heterogeneous UAV formation is organized as follows

[0014]

[0015] Where i>j, i=1,2,...,7, j=0,1,...,6.

[0016] remember

[0017]

[0018] Where i>j, i=1,2,...,7, j=0,1,...,6.

[0019] The optimization cost function is

[0020]

[0021] Thus, the problem of solving the nonlinear equation system (2) is transformed into finding X such that the cost function Achieve the minimum nonlinear optimization problem.

[0022] Step 3: Particle swarm collaborative positioning solution based on inertial measurement information

[0023] Combined with the low-cost unmanned aerial vehicle position information measured by the inertial navigation system, the particle swarm algorithm is used to search the low-cost unmanned aerial vehicle position to achieve collaborative positioning of the flight formation.

[0024] First, the algorithm parameters are initialized. The parameters to be initialized are as follows:

[0025] Population size g num .

[0026] Particle velocity v, maximum particle velocity

[0027] Iteration related parameters h and M max , are the number of iterations and the upper limit of the number of iterations respectively.

[0028] Algorithm stopping accuracy requirement parameter p e and g e , represent individual accuracy and group accuracy respectively.

[0029] The learning factors are l1 and l2.

[0030] The weight parameter is q, q They represent weight, upper weight bound and lower weight bound respectively.

[0031] Secondly, initialize the particle swarm

[0032] Measuring position with the current inertial navigation system is the center of the sphere and the upper bound of the inertial navigation system error E m G is randomly generated in a spherical space with a radius of num Particles.

[0033] Next, calculate the update

[0034] The optimal position that the particle has passed and the optimal position that the population has passed are P b and G b , by comparing the current P b and G b The best P in its own history b and G b, if it is better, update P b and G b .

[0035] Further, update the particle position and velocity

[0036] Generate random numbers rr1 and rr2, and update the particle position and velocity according to the following formula

[0037]

[0038] Determine whether the current result meets the stop condition

[0039]

[0040] If the iteration limit is met or reached, the search is stopped and the collaborative positioning result is obtained. If it is not met, the iteration continues.

[0041] The above steps can be used to iteratively solve the position of low-cost and low-precision unmanned aerial vehicles in the formation.

[0042] The present invention proposes a single-leader heterogeneous low-cost UAV formation collaborative positioning method under the leader-follower communication architecture, which solves the problem of low-cost and low-precision UAV positioning in the current heterogeneous formation through data link ranging.

[0043] The collaborative positioning method designed by the present invention has good applicability, and the solution speed and accuracy can be improved by improving the search method. It is easy to meet the needs of various centralized collaborative tasks. Similar methods have not been reported yet. It is an original theoretical innovation, and additional advantages can be obtained through the practice of the present invention. BRIEF DESCRIPTION OF THE DRAWINGS

[0044] To facilitate understanding and description, a schematic diagram of the framework construction is given and explained in conjunction with the implementation method.

[0045] Figure 1 It is the topology structure of heterogeneous formation data link communication network under the leader-follower framework.

[0046] Figure 2 It is the real-time position distribution of a single-leader heterogeneous formation.

[0047] Figure 3 It is the XY plane projection of the collaborative positioning solution result of the single leader-7 low-cost heterogeneous unmanned aerial vehicle formation.

[0048] Figure 4 It is the XZ plane projection of the collaborative positioning solution result of the single leader-7 low-cost heterogeneous unmanned aerial vehicle formation.

[0049] Figure 5 It is the fitness curve of cooperative positioning of single leader-7 low-cost heterogeneous unmanned aerial vehicle formation. DETAILED DESCRIPTION

[0050] The single-leader heterogeneous unmanned aerial vehicle formation collaborative positioning method proposed in the present invention is based on an undirected fully connected network topology under a leader-follower architecture, constructs and solves a collaborative positioning nonlinear equation group through data link ranging, and uses a particle swarm method to search and obtain the positions of low-precision and low-cost unmanned aerial vehicles in the formation in combination with inertial navigation measurement information.

[0051] Embodiments of the present invention are described in detail below. The embodiments are exemplary and intended to be used to explain the present invention, but should not be construed as limiting the present invention.

[0052] In this example, a 1 leader-7 low-cost known formation collaborative positioning method designed according to the method of the present invention realizes collaborative positioning of a leader-follower heterogeneous unmanned aerial vehicle formation based on the leader position, the low-cost unmanned aerial vehicle inertial navigation measurement position and the data link measurement aircraft spacing information.

[0053] The actual position of the low-cost unmanned aerial vehicle in this example is given below

[0054] Low-cost UAV M1: Current location (1200m, 1200m, 2221m)

[0055] Low-cost UAV M2: Current location (2100m, 1200m, 1012m)

[0056] Low-cost UAV M3: Current location (1600m, 2100m, 1123m)

[0057] Low-cost UAV M4: Current location (2500m, 1300m, 1647m)

[0058] Low-cost UAV M5: Current location (1800m, 2000m, 2030m)

[0059] Low-cost UAV M6: Current location (1900m, 1500m, 2196m)

[0060] Low-cost unmanned aerial vehicle M7: Current location (2187m, 1741m, 1429m)

[0061] The single-leader low-cost heterogeneous unmanned aerial vehicle formation collaborative positioning provided by the present invention is verified as follows:

[0062] Step 1: Build a single-leader low-cost heterogeneous UAV formation data link communication network

[0063] The current position of team leader M0 is known to be (2000m, 4000m, 3500m).

[0064] The measurement position of a low-cost unmanned aerial vehicle with an upper limit of the inertial measurement error Em of 100m is known:

[0065] Low-cost UAV M1: Measurement position (1201m, 1202.1mm, 2224.1m)

[0066] Low-cost UAV M2: measurement position (2106.5m, 1183.7m, 1063m)

[0067] Low-cost UAV M3: measured positions (1563.2m, 2144.8m, 1131.4m)

[0068] Low-cost UAV M4: measurement position (2563m, 1291.6m, 1708.1m)

[0069] Low-cost UAV M5: measurement positions (1840.8m, 2013.3m, 2065.9m)

[0070] Low-cost UAV M6: measured positions (1899.4m, 1497.8m, 2202.7m)

[0071] Low-cost UAV M7: measured positions (2243.7m, 1797.6m, 1487.9m)

[0072] Build Figure 1 The data link communication network structure shown in the figure allows the leader to obtain the distance between all aircraft in the formation and the leader's position at each moment through data link communication.

[0073] R 10 =3180.5m, R 20 =3747m, R 30 =3069.2m, R 40 =3312.6m, R 50 =2490.2m, R 60 =2821.4m, R 70 =3070.4m, R 21 =1507.2m, R 31 =1475m, R 41 =1424.6m, R 51 =1018.1m, R 61 =762m, R 71 =1376.3m, R 32 =1035.5m, R 42 =757.1m, R 52 =1329m, R 62 =1237.7m, R 72 =688.6m, R43 =1313.2m, R 53 =934.3m, R 63 =1265.4m, R 73 =753.1m, R 54 =1061.5m, R 64 =837.5m, R 74 =583.1m, R 65 =536.2m, R 75 =760.3m, R 76 =853.7m

[0074] Step 2: Construct a set of equations for cooperative positioning of a single-leader low-cost heterogeneous UAV formation

[0075] According to the aircraft distance and leader position obtained by data link ranging, the collaborative positioning nonlinear equation group P(X) is constructed as shown in formula (2).

[0076] Step 3: Particle swarm collaborative positioning solution based on inertial measurement information

[0077] First, the algorithm parameters are initialized. The parameters to be initialized are as follows: population size g num =100, maximum particle speed The upper limit of the number of iterations M max =1000, the algorithm stops requiring accuracy parameter p e = 1m and g e =5m, learning factors l1 = 1.5, l2 = 1.8. Upper bound of weight parameters The parameter lower bound is q=0.2.

[0078] The particle swarm algorithm is used to iteratively solve the collaborative position information. It can be seen that the fitness of 276 iterations max|P ij |=0.3m satisfies the group accuracy condition, the iteration stops, and the collaborative positioning results are as follows:

[0079] Low-cost unmanned aerial vehicle M1: solved position (1201m, 1195.5m, 2228.5m), measurement error 3.9m, positioning error 8.8m;

[0080] Low-cost unmanned aerial vehicle M2: solved position (2098.7m, 1195.1m, 1017.5m), measurement error 53.9m, positioning error 7.5m;

[0081] Low-cost UAV M3: solved position (1596.5m, 2094.1m, 1127.8m), measurement error 58.6m, positioning error 8.4m;

[0082] Low-cost UAV M4: solved position (2499.6m, 1297.2m, 1651.5m), measurement error 88.2m, positioning error 5.3m;

[0083] Low-cost UAV M5: solved position (1798.9m, 1996.5m, 2034.5m), measurement error 56m, positioning error 5.9m;

[0084] Low-cost UAV M6: solved position (1900.4m, 1496.9m, 2201.2m), measurement error 7m, positioning error 6m;

[0085] Low-cost UAV M7: solved position (2185m, 1737.1m, 1433m), measurement error 99.4m, positioning error 6m.

[0086] The obtained UAV position information is introduced into the collaborative guidance law to verify the effectiveness of the collaborative positioning method.

[0087] Figure 2 Real-time position distribution of a single-leader heterogeneous formation. Figure 3 It is the XY plane projection of the collaborative positioning solution result of the single leader-7 low-cost UAV heterogeneous UAV formation. Figure 4 It is the XZ plane projection of the collaborative positioning solution result of the single leader-7 low-cost UAV heterogeneous UAV formation. Figure 5 It is the fitness curve of cooperative positioning of heterogeneous UAV formations of single leader-7 low-cost UAVs. Figure 3 and Figure 4 In the above, a search circle is drawn with the IMU measurement position as the center and the maximum IMU drift error of 100m as the radius to determine the search range. Figure 5 The fitness curve of the collaborative positioning equations in this example is solved by the particle swarm algorithm, and the fitness calculation results in the iterative solution process of the algorithm are given. In this example, the particle swarm algorithm is combined with the inertial group measurement position information and the inertial group error range to search. With the increase of the number of iterations, the fitness gradually decreases. The stop condition is met at 276 iterations. The positioning accuracy of the low-cost unmanned aerial vehicle is less than 9m, and the collaborative positioning effect is good.

[0088] This method can achieve more accurate collaborative positioning based on data link ranging and positioning of low-cost inertial navigation systems with relatively large errors, and provides a good information basis for collaborative combat of a single-leader heterogeneous low-cost unmanned aerial vehicle formation.

[0089] This implementation case is an explanation and illustration of the technical solution of the present invention, and is only used as an example to verify the effectiveness of a single-leader heterogeneous low-cost unmanned aerial vehicle formation collaborative positioning method, and cannot be used to limit the scope of protection of the rights. For those skilled in the art, several changes, modifications, substitutions, variations and improvements can be made based on the single-leader heterogeneous low-cost unmanned aerial vehicle formation collaboration of the present application according to the needs of engineering practice. Any only partial changes made according to the claims and description of the present invention should still fall within the scope of protection of the present invention.

Claims

1. A single-leader heterogeneous low-cost unmanned aerial vehicle formation collaborative positioning method, characterized in that: The steps include: Step 1: Build a single-leader low-cost heterogeneous UAV formation data link communication network: High-performance leader M0 real-time update accurate position coordinates (x 0 ,y 0 , z 0 ); The seven follower aircraft equipped with low-cost inertial navigation systems are denoted as M i (i=1,2,...,7), the corresponding real coordinate position is unknown and is recorded as (x i ,y i , z i ); The upper bound of the low-cost unmanned aerial vehicle assembly error is Em inertial navigation system, which can achieve its own rough positioning, denoted as The single leader ensures the connectivity with all the following aircraft in the formation, and the seven following UAVs in the formation are guaranteed to be undirected and fully connected, that is, the distance between all aircraft in the UAV formation can be obtained through data link ranging and transmitted to the leader for calculation and processing; the distance between aircrafts obtained by data link measurement is R ij , i≠j, i, j=0, 1, ..., 7, where R ij =R ji ; Step 2: Construct a set of equations for collaborative positioning of a single-leader low-cost heterogeneous UAV formation: First, let X = (x 1 , x 2 , ..., x 7 ,y 1 , ..., y 7 , z 1 , ..., z 7 ), the nonlinear vector of cooperative positioning of heterogeneous UAV formation is organized as follows Where i>j, i=1,2,...,7, j=0,1,...,6; remember Where i>j, i=1,2,...,7, j=0,1,...,6; The optimization cost function is Thus, the problem of solving the nonlinear equation system (2) is transformed into finding X such that the cost function Achieve the minimum nonlinear optimization problem; Step 3: Particle swarm collaborative positioning solution based on inertial group measurement information is used to obtain the position of low-cost and low-precision UAVs in the formation. The specific process is: combining the low-cost UAV position information measured by the inertial navigation system, using the particle swarm algorithm to search for the low-cost UAV position to achieve collaborative positioning of the flight formation, which specifically includes the following processes: First, the algorithm parameters are initialized; the parameters to be initialized are as follows: Population size g num ; Particle velocity v, maximum particle velocity Iteration related parameters h and M max , respectively, the number of iterations and the upper limit of the number of iterations; Algorithm stopping accuracy requirement parameter p e and g e , represent individual accuracy and group accuracy respectively; The learning factors are l1 and l2; The weight parameter is Represent weight, upper weight bound and lower weight bound respectively; Secondly, initialize the particle swarm Measuring position with the current inertial navigation system is the center of the sphere and the upper bound of the inertial navigation system error E m G is randomly generated in a spherical space with a radius of num Particles; Next, calculate the update The optimal position that the particle has passed and the optimal position that the population has passed are P b and G b , by comparing the current P b and G b The best P in its own history b and G b , if it is better, update P b and G b ; Further, update the particle position and velocity Generate random numbers rr1 and rr2, and update the particle position and velocity according to the following formula Determine whether the current result meets the stop condition If the iteration limit is met or reached, the search is stopped and the collaborative positioning result is obtained. If it is not met, the iteration continues.