=Paper=
{{Paper
|id=Vol-2372/SEIM_2019_paper_27
|storemode=property
|title=Path planning for UAV search using growing area algorithm and clustering
|pdfUrl=https://ceur-ws.org/Vol-2372/SEIM_2019_paper_27.pdf
|volume=Vol-2372
|authors=Alexander Fedorov
}}
==Path planning for UAV search using growing area algorithm and clustering
==
Path planning for UAV search using growing area algorithm and clustering Alexander Fedorov Higher School of Economics Saint Petersburg, Russia afedorov2602@gmail.com Abstract—This paper presents a novel approach to planning a path for unmanned aerial vehicles (UAVs) for searching lost targets under uncertainty. A new basic approach for fast and effective solutions is developed which outperforms standard local hill climbing (LHC) approach. This can be improved using a clusterization of probabilities in the area. The idea allows us to simplify the problem of planning a UAV path to a problem of choosing several clusters. Finally, the proposed method is com- pared with other methods in simulated scenarios. The comparison shows its high efficiency to solve searching problems. Index Terms—unmanned aerial vehicles (UAVs), path planning, object detection, probability distribution Fig. 1: Example of a probability grid [2] I. I NTRODUCTION Unmanned aerial vehicles are gaining popularity both in A typical size of a probability grid for a search problem civilian and military fields. They can be used for wildlife mon- is tens of thousands squares [3]. The total probability in the itoring, target tracking, reconnaissance, surveillance, search search area should be equal to 1 and thus and rescue, area patrolling and battle damage assessment. ∑ pi,j = 1. (1) For many of these mission time is critical and should be i,j minimized. Minimizing time in this paper means minimizing length of UAV paths. We denote a UAV path as R = (R1 , . . . Rk ), where Most of the problems mentioned above cannot be solved Ri ∈ {1, . . . , W } × {1, . . . , H}, the initial cell where the optimally in polynomial time. The complexity of a general drone is located as S ∈ {1, . . . , W } × {1, . . . , H} and the searching problem is NP-hard [1]. This paper focuses on length of the path as L. effective solutions which means that the proposed method can Then the search problem then can be formulated as follows: be only a suboptimal heuristic polynomial-time solution. Given probability grid with known probabilities pi,j , the initial position of an UAV S and maximum length of the path L we II. P ROBLEM FORMULATION should: ∑ There are various types of UAVs with different characteris- maximize px,y R (x,y)∈R tics, but we will have the following assumptions: • UAVs can maintain a constant height above the ground; subject to R1 = S • UAVs have a gimballed camera; ∑ k−1 • at some constant height, UAVs see below using the and distance(Ri , Ri+1 ) ≤ L, i=1 camera a square of size a on the ground; • UAVs travel with known constant speed; where distance(a, b) is Euclidean distance between centers • UAVs can make a 90-degree turn if necessary. of cells a and b. In the paper, we supposed that the area of search is discretized into N = W × H squares of size r which means In other words, we want to find a path that that flying above the center of a square at known constant • visits some squares and collects probabilities from them height a UAV can see it fully. For each square (i, j) (denoted by performing a scan; by the number of its column and row) the probability that the • has a length no more than L; target is in this square is known and equal to pi,j ∈ [0, 1]. • maximizes probability collected. See Fig. 1 for the example of such discretization with known Note that there is no benefit from visiting (scanning) the same probabilities. square twice. III. R ELATED WORK doesn’t always mean that the solution is non-optimal but This problem is a special case of Orienteering problem [4] can be usually avoided in such a way that the resulting with a grid structure instead of a general case of a graph. route will have higher probability collected; Orienteering problem is a more complex version of traveling • A solution may miss cells with high probability because salesman problem (TSP), is known to be NP-hard and has no in some moment visiting them is locally non-optimal, fully polynomial approximation scheme unless P=NP [5]. but visiting them in future may be valuable. Local hill The considered problem may be solved with mixed integer climbing algorithm is unlikely to visit these cells in future linear programming (MILP) [6], genetic algorithm [7] and ant because in each step in chooses the next cell only from colony optimization [8]. Nevertheless, these approaches are four adjacent cells. effective only for a small number of nodes (less than 100). The basic approach for fast solutions of this problem usually is local hill climbing [9]. It is a greedy solution in which in each step a UAV flies to one of neighbours of its current cell choosing the cell with the maximum probability. However, the main problem of this approach is that the drone can’t leave an area of local maximum and fly to a better area unless it covers the area fully (see Fig. 2). Fig. 3: Example of problems in solutions generated by algo- rithms based on local hill climbing. In black circles there are cells that are visited twice. In purple circles there are cells with high probability that are skipped by the solution. In the yellow circle there are cells that can be skipped instead of Fig. 2: Example of a problem of LHC when a drone can’t get cells in purple circles. to an area of high probability. The more green a cell is the more probability it contains. The route is blue and the initial B. Basic idea UAV position is a purple square. Lemma. Any area of cells consisting of connected cells of double size (i.e. consisting of four small cells) may be covered Different authors tried to overcome the problem. Lanillos with a hamiltonian cycle which goes through centers of small et al. supposed to calculate not only real probability the drone cells. collects flying in a direction but also expected probability that The proof of the lemma may be found in [12]. it can collect there [10]. Moreover, he uses receding horizon The algorithm to get the hamiltonian cycle is simple: optimization (RHC) to increase the number of steps the drone 1) Build a spanning tree on cells of double size (Fig. 4). It look ahead and to make routes more locally optimal. Yao et al. can be built because the area is connected. clusterize an area to detect areas of high probability [11]. In 2) A path along the spanning tree is a hamiltonian cycle each of the clusters, he builds routes separately using RHC and needed (Fig. 5) then joins them. To use clustering the probability distribution is supposed to be good, i.e. we can clearly see subareas of high and low probability. Lin et. al proposes using of global warming effect optimization which allows the drone to ignore cells with low probability [3]. IV. P ROPOSED ALGORITHM A. Issues of analogs As it was stated before, effective (fast) solutions for the problem are usually based on local hill climbing algorithm. However, as a consequence, these algorithms ([10][11][3]) Fig. 4: (a) Area of cells of double size. (b) A spanning tree have the following issues (Fig. 3): on cells of double size.[12] • Final routes visit a lot of cells twice. Visiting a cell more This lemma brings us to the following idea: Instead of than once doesn’t increase the probability of detecting. It building a path we will build an area of cells of double size. Fig. 5: A path along the spanning tree [12] To maintain connectivity we may add to the area only cells that are neighboring to it. As in local hill climbing, we can Fig. 7: Area after the end of the greedy algorithm use greedy algorithms, i.e. among all possible cells of double size add the one that contains more probability (this can be done effectively by using, e.g., a heap data structure). Note step by step (increasing complexity of an algorithm in a linear that at every step we preserve connectivity of an area of cells of the number of clusters time). of double size and it is the only constraint needed to use the Then combining two ideas we get the following algorithm: lemma. 1) Choose what clusters to join. After building the area we will build a hamiltonian cycle 2) Join them and the starting position of a UAV with an using the lemma and it will be the final route of a UAV. Note area of cells of double size. that as we will build a hamiltonian cycle we know how many 3) Grow the area step by step while not exceeding the cells we need to add to the area not to exceed the constraint constraint on the route length. on the length of the final route. 4) Get the hamiltonian cycle from the area using the C. Improvement with clustering lemma. This idea may be improved by the use of clustering. The total complexity of steps 2-4 is O(L log N ) if using a Suppose we have detected all clusters (subareas of high heap to pick the cell with the highest probability effectively. probability). If we join centers of all clusters and the starting We will call the algorithm "cluster area-growth algorithm". position of a drone by an area of cells of double size (e.g, V. E XPERIMENTS using minimal spanning tree (MST) or Steiner tree, Fig. 6) and then run our greedy algorithm then the area will grow The proposed cluster area-growth algorithm was imple- accurately in clusters (Fig. 7). mented and compared with local hill climbing algorithm and lhc-gw-conv algorithm from [3] (with global warming effect). The comparison was performed on several test areas. Some of the areas were generated using several Gaussian distri- butions and some of these areas were obtained from height maps of real locations (because the form of those maps and real probability maps are similar). For every area, there were several measurements with different constraints on the length of the route (L). In the cells, there are total probabilities collected by solutions in given constraints on a particular test. As it can be seen in Table I the proposed algorithm outperformed other algorithms almost in every case. Basic local hill climbing approach gives dramatically worse results in all tests. The proposed solution gained worse result only when constraint on the length of the route is tight. It is because other solutions were not obliged to return the drone to its starting Fig. 6: Clusters joined by an area of cells of double size position (i.e. to form a cycle). As a result, their routes got the opportunity to cover more clusters or to cover more distant In some cases (when the constraint on the length of the clusters (see Fig. 8 and Fig. 9). However, as the constraint route is tight) it is better to join not all cluster but only a few increases the proposed solution becomes to get better and of them. To choose what clusters to join we may iterate over better results in comparison with other solutions (see Fig. 10 all possibilities (if there are a small number of clusters, which and Fig. 11), because of the absence of those issues mentioned is a pretty common case) or just try to pick the nearest cluster above. TABLE I: Results of testing Test #1 Test #2 L=3000 L=7000 L=15000 L=3000 L=7000 L=15000 proposed 14% 31.2% 60.1% 8.1% 19.3% 40% lhc 13.3% 23.7% 43.3% 6.2% 16.5% 35.2% lhc-gw-conv 14.1% 30.8% 55.8% 8.6% 19.1% 38.2% Test #3 Test #4 L=3000 L=7000 L=15000 L=3000 L=7000 L=15000 proposed 19.6% 39.9% 66.8% 24.4% 50.3% 84% lhc 19.2% 36.8% 62.2% 23.9% 42% 71.7% Fig. 10: Test 1 with constraint L = 15000, lhc-gw-conv 19.4% 38.7% 65% 24.2% 48.7% 78.1% proposed solution Fig. 11: Test 1 with constraint L = 15000, lhc- gw-conv VI. C ONCLUSION The proposed solution has following next advantages: Fig. 8: Test 1 with constraint L = 3000, proposed solution • The idea simplifies the problem of building a path over an area to a problem of choosing several clusters (number of clusters is far less than the number of cells in the area); • The solution can not visit the same cell twice because we have a hamiltonian cycle; • The solution does not miss probabilities because an area can grow in all directions (not only 4 adjacent cells may be added); • As a result, it has better efficiency (according to the tests); • It always returns a drone to the starting position which is good when the constraint on the length of the route is due to limited battery charge of a UAV. We compared the solution with other solutions in simulated scenarios to show its high efficiency. The ideas from the paper Fig. 9: Test 1 with constraint L = 3000, lhc-gw- may be also used in other search problems to simplify them conv and get more practical solutions. In future work this approach can be improved by considering the number of turns in the path (which should be also minimized). ACKNOWLEDGEMENTS This paper was done under research work in Simlabs Inc. (sim-labs.com) R EFERENCES [1] K E. Trummel and J R. Weisinger, “The complexity of the optimal search path problem,” Operations Research, vol. 34, pp. 324–327, Apr. 1986. [2] A. Otto, N. Agatz, J. Campbell, B. Golden, and E. Pesch, “Optimization approaches for civil applications of unmanned aerial vehicles (uavs) or aerial drones: A survey,” Networks, vol. 72, pp. 411–458, Mar. 2018. [3] L. Lin and M. Goodrich, “Uav intelligent path planning for wilderness search and rescue,” Dec. 2009, pp. 709– 714. [4] P. Vansteenwegen, W. Souffriau, and D. Van Oudheus- den, “The orienteering problem: A survey,” European Journal of Operational Research, vol. 209, pp. 1–10, Feb. 2011. [5] P. Sokkappa and S. U. D. of Operations Research, The Cost-constrained Traveling Salesman Problem. Stan- ford University, 1990. [Online]. Available: https : / / books.google.ru/books?id=jax3JAAACAAJ. [6] H. Oh, S. Kim, A. Tsourdos, and B. White, “Coordi- nated road-network search route planning by a team of uavs,” International Journal of Systems Science, pp. 1–16, Dec. 2012. [7] M. Tasgetiren and A. Smith, “A genetic algorithm for the orienteering problem,” vol. 2, Feb. 2000, pp. 910– 915. [8] Y.-C. Liang and A. Smith, “An ant colony approach to the orienteering problem,” Journal of The Chinese Institute of Industrial Engineers, vol. 23, pp. 403–414, Jan. 2006. [9] S. Thrun, W. Burgard, and D. Fox, Probabilistic Robotics (Intelligent Robotics and Autonomous Agents). The MIT Press, 2005, ISBN: 0262201623. [10] P. Lanillos, S. K. Gan, E. Besada, G. Pajares, and S. Sukkarieh, “Multi-uav target search using decentralized gradient-based negotiation with expected observation,” Information Sciences, vol. 282, pp. 92 –110, Oct. 2014. [11] P. Yao, W. Honglun, and H. Ji, “Gaussian mixture model and receding horizon control for multiple uav search in complex environment,” Nonlinear Dynamics, vol. 88, pp. 903919, Jan. 2017. [12] Y. Gabriely and E. Rimon, “Spanning-tree based cov- erage of continuous areas by a mobile robot,” Annals of Mathematics and Artificial Intelligence, vol. 31, pp. 77–98, Feb. 2001.