• <tr id="yyy80"></tr>
  • <sup id="yyy80"></sup>
  • <tfoot id="yyy80"><noscript id="yyy80"></noscript></tfoot>
  • 99热精品在线国产_美女午夜性视频免费_国产精品国产高清国产av_av欧美777_自拍偷自拍亚洲精品老妇_亚洲熟女精品中文字幕_www日本黄色视频网_国产精品野战在线观看 ?

    Improved lazy theta* algorithm based on octree map for path planning of UAV

    2023-05-31 01:33:18MengshunYuanTongleZhouMouChen
    Defence Technology 2023年5期

    Meng-shun Yuan,Tong-le Zhou,Mou Chen

    College of Automation Engineering, Nanjing University of Aeronautics and Astronautics, Nanjing, 211106, China

    Keywords: Unmanned aerial vehicle Path planning Lazy theta* algorithm Octree map Line-of-sight algorithm

    ABSTRACT This paper investigates the path planning method of unmanned aerial vehicle (UAV) in threedimensional map.Firstly,in order to keep a safe distance between UAV and obstacles,the obstacle grid in the map is expanded.By using the data structure of octree,the octree map is constructed,and the search nodes is significantly reduced.Then,the lazy theta* algorithm,including neighbor node search,line-of-sight algorithm and heuristics weight adjustment is improved.In the process of node search,UAV constraint conditions are considered to ensure the planned path is actually flyable.The redundant nodes are reduced by the line-of-sight algorithm through judging whether visible between two nodes.Heuristic weight adjustment strategy is employed to control the precision and speed of search.Finally,the simulation results show that the improved lazy theta* algorithm is suitable for path planning of UAV in complex environment with multi-constraints.The effectiveness and flight ability of the algorithm are verified by comparing experiments and real flight.

    1.Introduction

    With the development of UAV technology,UAV has been applied in many fields.In the field of national defence,Military UAV can accomplish tasks such as intelligence reconnaissance,signal transmission,electronic countermeasure,target hitting and target aircraft [1].Path planning is an indispensable part of the UAV mission planning system,which can significantly improve the operational capability of military UAV,so it has been widely concerned in recent years and has become a research hotspot of military UAV technology [2].In path planning,the algorithm needs to plan a reasonable flight path for UAV from the starting point to the ending point in the given map[3].The path should meet the safety,rapidity and the corresponding constraints [4].Thus the path planning has always been the research hot topic of intelligent control and decision making for UAV.

    The first step of path planning is to build the map,and the classical method is grid map modeling.In Refs.[5,6],the regular grid map was used for its simplicity and convenience.In threedimensional map,the number of path nodes in regular grid maps is huge,and the search algorithm takes a long time to run.In Ref.[7],based on the octree data structure,the octree map significantly reduced the number of map path nodes,shorten the search time,and achieve better results.When the UAV is flying,it not only needs to consider the performance limitations of UAV,but also needs to consider the constraints of threat area,such as no fly zone.In Refs.[8-10],these methods translate avoiding threat zones and no-fly zones into geometric calculations that allow the UAV to eventually reach the target position.At the same time,there exists an obstacle edge collision problem in the grid map [11].Thus,it is necessary to expand the obstacles so that the UAV can keep a safe distance from the obstacles.

    After the completion of map modeling,path planning should be carried out [12].In three-dimensional path planning,some works can be found in the literature.In Ref.[13],an improved ant colony(ACO) algorithm was used in path planning.Focusing on the path planning problem of UAV,an improved particle swarm optimization (PSO) algorithm was proposed to plan path in Ref.[14].Improved Rapidly-Exploring Random Tree (RRT) algorithm has strong randomness and can quickly obtain the feasible path,but it can't obtain the optimized path [15,16].Heuristic algorithm is a series of algorithms derived from A*algorithm[17].In Ref.[18],the modified A*algorithm was based on the cost function and was used to solve the three dimensional path planning problem.In Ref.[19],the Theta*algorithm was proposed based on A*algorithm to solve the any angle path planning problem.In Ref.[20],the lazy theta*algorithm was applied to the grid map to plan the path.The planned path of lazy theta* algorithm not only has fewer nodes and shorter search time,but also is smooth,which is beneficial for the UAV to fly along the path.Based on the above research results,in order to quickly plan a safe,smooth and low-cost path [21],an optimization algorithm is proposed by combining octree map with lazy theta* algorithm.

    This paper is organized as follows.Firstly,problem description of the path planning problem is given,including four parts: UAV constraints,obstacle expansion,the octree map and neighbor node search.Then,the flow of the algorithm is described in detail.This algorithm first performs obstacle grid expansion on the original map information,then builds the octree map,and then uses the improved lazy theta* algorithm to plan path,which improves the neighbor node search,line-of-sight algorithm and heuristic weight adjustment.Finally,the simulation results are given to show the planned path which can meet the requirements.

    2.Problem statement

    The path planning problem of UAV can be transformed into an optimization problem with multiple constraints[22].The planning space is a three-dimensional grid map,and each grid is a search node.Therefore,the problem of path planning [23]can be described as: under the premise of satisfying the constraint conditions,the continuous path nodes are selected from the grid map nodes,so that the UAV has the minimum path cost when flying along the path nodes[24].

    2.1. UAV constraint and threat area constraint

    To guarantee that the planning path is actually flyable,it is necessary to consider UAV maneuverability,terrain,threat and other constraints [25].

    (1) Maximum yaw angle constraint:Due to the limitation of UAV maneuverability,the planned yaw angle should be less than the maximum yaw angle [26]as shown in Fig.1.The maximum yaw angle constraint can be expressed as

    Fig.1.Maximum yaw angle constraint.

    where,θirepresents the yaw angle at path point of sectioni,and θmaxrepresents the maximum yaw angle.

    (2) Maximum pitch angle constraint: Due to the influence of UAV thrust,gravity and other factors,there is a certain limit value of UAV's pitching ability [27].The maximum pitch angle constraint can be expressed as

    where,φirepresents the pitch angle at path point of sectioni,and φmaxrepresents the maximum pitch angle of the UAV.

    (3) Minimum path segment length constraint: Limited by the maneuverability of UAV,the UAV must guarantee a shortest straight-line flight distance before changing its course[28]as shown in Fig.2.The minimum path segment length constraint can be expressed as

    Fig.2.Path segment length.

    where,lirepresents the path length of sectioni,andlminrepresents the shortest direct flight distance of UAV.

    (4) Minimum relative height constraint: In order to ensure the flight safety,the UAV needs to keep a certain relative safe distance from the ground during the flight as shown in Fig.3.The minimum relative height constraint can be expressed as

    Fig.3.Minimum relative height constraint.

    where,zrepresents the altitude of the current path point,hminrepresents the minimum relative height,andhTindicates the terrain altitude directly below the UAV.

    (5) Threat area constraint:In order to ensure flight safety,UAV is required to be located outside the threat area at any time[29].The model of threat area needs to be built on the specific situation of threat objects [30],generally including sphere,cylinder,etc.Fig.4 shows the cylindrical threat zone,indicating the threat of the no fly zone.

    Fig.4.No fly zone constraint.

    2.2. Obstacle grid expansion

    The path searched directly in the grid map may collide with the edge of the obstacle grid[31].Fig.5 shows the collision problem of the grid edge in the two-dimensional map.This problem also exists in three-dimensional map.In order to ensure the safety of UAV flight path,it is necessary to deal with the edge of obstacles.

    Fig.5.Edge collision problem.

    The obstacles expansion method is used to expand the obstacles in the initial map.Based on the obstacles,a certain area around the obstacles is set as the obstacle area.Hence,the corresponding expansion range can be set according to the threat degree of the obstacles.After obtaining the processed map data,the octree map is constructed.The new map can keep a safe distance between UAV and obstacles in flight.

    2.3. Octree map model

    Octree map has been studied in the map model,which is established based on the data structure of octree.The octree map schematic diagram is shown in Fig.6.The process of building octree map is to divide the big cube into eight pieces until it becomes the minimum grid.Furthermore,the size of the minimum grid can be set.Generally,the smaller map grid indicates the higher search accuracy.In the data structure of octree,the whole big cube is the root node,and the smallest block is the leaf node.In the octree map,the volume of the upper node is eight times of that of the lower node.

    Fig.6.Octree map schematic diagram.

    In octree map,nodes store their own information,including coordinate,size and state.When there is no obstacle in the grid,it is marked as free grid,otherwise it is marked as obstacle grid.Octree map is different from the traditional grid.When all the child nodes of a node are in the same state,it is not necessary to expand this node.In the process of map construction,the grid will be automatically divided into smaller grids in the area with dense obstacles.Therefore,in octree map,the size of grid is different and the number of nodes is small.These advantages are conducive to the subsequent path planning.

    2.4. Neighbor node search

    This paper builds an octree map,so the neighbor node search method in the algorithm needs to be changed.Obtaining a neighbor node set is divided into four steps.

    Step 1.The coordinate ofsis(x,y,z).The length,width and height ofsare bothw.Build a new gridBoxwith coordinate(x,y,z).The length,width,and height ofBoxare bothw+2.The grid that intersects the new grid is added to the neighbor node set.Theneiis the neighbor node,andP(s)is the parent node ofs.

    Step 2.The grid in the neighbor node set is judged,and the grid whose state is the leaf node constitutes a new set of neighbor nodes.

    Step 3.Considering the limits of the yaw and pitch angles of the UAV,the maximum yaw and maximum pitch angles need to be reasonably preset.If the neighbor node meets the yaw angle constraint and pitch angle constraint,it will be retained,otherwise it will be discarded.The algorithm deletes nodes that do not meet the constraints,and then gets a new set of neighbors.

    Step 4.The grid state is determined and the free grids constitute the final set of neighbor nodes.

    Step 5.Determine if all nodes are searched ? If yes,the search is finished,otherwise return to Step 2.

    The flow chart of obtaining a neighbor node set is as follows(Fig.7):

    Fig.7.Flow chart of neighbor node search.

    3.Improved lazy theta* algorithm

    Before introducing the improved algorithm,some variables and functions of the algorithm are defined.

    Definition 1.Record the current node ass,the neighboring node of the current node iss′,the starting node issstart,the ending node issgoal,and the Euclidean distance is expressed byeuc(s,s′).

    Definition 2.The node coordinate is the grid center coordinate.For the given starting node and ending node coordinate,the algorithm takes the starting grid node coordinate as the starting node coordinate,and the ending grid node coordinate as the ending node coordinate.

    Definition 3.Define the Euclidean distance cost betweensands′asc(s,s′).The Manhattan distance cost betweensandsgoalis defined ash(s).

    Definition 4.The line-of-sight algorithm for judging whether there is an obstacle between two nodes is represented bylineofsight(s,s′).TheNeighb(s)is the set of neighbor nodes ofs.The argmin(s)can get the node with the lowest cost in the intersection set of theNeighb(s)and the close list.

    The algorithm first expands obstacle grids on the original map information,then builds the octree map,and then uses the improved lazy theta* algorithm to search path.Improved lazy theta* algorithm modifies the neighbor node search,line-of-sight algorithm and heuristic weight adjustment,etc.Through these improvements,the desired path is finally found.

    3.1. Line-of-sight algorithm

    Line-of-sight algorithm can judge whether there are obstacles between two points.For grid matrix environments,the line-ofsight algorithm and the line drawing algorithm are very similar.The line drawing algorithm needs to calculate the position of the grid that is filled when the line is drawn on the grid matrix.For lineof-sight algorithm,a line is drawn between two points to determine whether there are obstacles on the line.

    Let the coordinates of the two grids be(x0,y0,z0)and(x1,y1,z1),dx,dy,dzare the difference of the three-axis coordinates of the two points,idis a variable that controls whether the line-of-sight algorithm ends,anddis the maximum of the |dx|,|dy|,|dz|.Thestepis the step size,anddistis the distance between the two points on the two-dimensional plane,and the calculation equation is as follows:

    The flow chart of line-of-sight algorithm is shown in Fig.8.In this figure,(ix,iy,iz)is the coordinate of the current step,andmap[x][y][z]==1 indicates that there is obstacle in the grid at coordinate(x,y,z).

    Fig.8.Line-of-sight algorithm.

    In Fig.8,condition 1 is shown in Eq.(6),andlen1 is the maximum size of the map.

    When the return value is true,there is no obstacle on the line between two points.When the return value is false,there are obstacles on the line between two points.

    3.2. Heuristics weight adjustment

    In the process of neighbor node search,the form of cost function can be expressed as

    whereg(s)represents the true cost from the starting node to the current nodes,h(s)represents the estimated cost of the current nodesto the ending node,and ε is the heuristic weighting factor(ε ≥1).The update of the heuristic weight is related to the location of the current nodes.If the distance between the current node and the ending node is farther,the planning speed will be faster.If the current node is closer to the ending node,the planning accuracy is higher.The update method is as follows:

    where △ε can be adjusted according to requirements.By increasing the weight factor of the heuristic,the search direction of the algorithm tends to end the node,thus reducing the search time of the algorithm.However,the weight of the heuristics should not be large,otherwise the algorithm will no longer have acceptability and will not satisfy the consistency condition.

    3.3. Path planning based on improved lazy theta* algorithm

    The main program of the improved lazy theta* algorithm is based on the lazy theta*algorithm,and the octree map modeling is added.The cost calculation method in the algorithm is described in detail in section 3.2.The main steps of the algorithm are as follows:

    (1) Processing the planning map,expanding the obstacles,and building an octree map model based on the data structure of octree;

    (2) Constructing open list and close list.During the search,the nodes waiting to be searched are added to the open list,and the searched nodes are added to the closed list;

    (3) Inserting the start node into the open list;

    (4) If the open list is empty,the calculation is stopped and the path search fails,otherwise performs the next step.

    (5) Selecting the node with the minimum cost in the open list as the new current nodes,removingsfrom the open list and inserting it to the close list;

    (6) Determining whethersis visible to its parent node.If the two points are visible,the algorithm performs the next step.Otherwise,the algorithm needs to find the node with the minimum cost from the intersection of theNeighb(s)and the close list,and set it as the parent node ofs;

    (7) Determining whether the current node is the end node?If it is the end node then the path is found.Otherwise search for neighbor nodes and add them to the open list,and return to Step 4).

    If the path is found,the complete path is obtained according to the relationship between the nodes.The main program flow chart of the improved lazy theta*algorithm is shown as follows (Fig.9).

    Fig.9.Flow chart of algorithm.

    In order to explain the algorithm clearly,the pseudocode of the main part of the algorithm is given below.The algorithm main function is shown in the pseudocode in Fig.10.FunctionMapCreate(map)is the octree map building function.FunctionSetvertex(s)sets parent node of current node.UpdateVertex(s,s′)updates the cost of adjacent nodes′.

    Fig.10.Main function.

    The sub-function is divided into two parts,one of which is shown in the pseudocode in Fig.11.This part is the basic subfunction of lazy teta * algorithm.FunctionSetvertex(s)determines whether s and its parent node are visible,corresponding to line 9 in the main function.UpdateVertex(s,s′)updates the cost of adjacent nodes′,corresponding to line 18 in the main function.ComputeCost(s,s′)is the function thatUpdateVertex(s,s′)needs,which calculates the cost of nodes′and sets its parent node.

    Fig.11.Help function 1.

    Another part of the sub-function is shown inHelperFunction2 in Fig.12.This part is octree map modeling and neighbor node search functions.MapCreate(map)is a function which builds an octree map based on the map information after the obstacle grids are expanded,corresponding to line 2 in the main function.The function is a recursive function that constantly calls itself until the map is divided into the smallest grid of constraints and finally returns the root noderoot.Node()is a node,set as a class in the program,which stores some information,including coordinate,size,node state,and so on.Theroot.valuemarks whether the node is obstacle grid,Trueindicates free grid,andFalseindicates obstacle grid.AllValueSame(map)is used to determine whether the grid in the map cube is in the same state.If the states are the same,the blocking of map is no longer continued,and the node state is marked and set as a leaf node.Theroot.ftopleftis the eighth subgrid of the current grid,and the omitting part is the construction of the other seven sub-grids,and the method is the same asroot.ftopleft.

    Fig.12.Help function 2.

    Neighb(s)is a neighbor node search function,and the function finally returns a set of neighbor node that meets the constraints,corresponding to line 13 in the main function.The function first usesIntersect(Box,s)to get the leaf nodes adjacent tos,then calculates the angle in the path according toAngle(P(s),s,nei),takes the nodes within the maximum yaw angle θmaxand the maximum pitch angle φmax,and finally adds the free grid to the set of neighbor nodes.

    4.Simulation results and analysis

    To verify the effectiveness of the improved Lazy Theta* algorithm,Windows 10 is used as the platform,and Python 3.6 is used to simulate the programming environment.The simulation hardware platform is Intel Core i5 4210 M processor,which has a clock speed of 2.6 GHz and 8 GB of memory.Under the same hardware platform,the algorithm is verified by using different sizes of maps.Then,in order to further illustrate the role of the algorithm,the ACO algorithm,improved ACO algorithm in Ref.[13],Improved RRT algorithm in Ref.[15],the sparse A* algorithm and the lazy theta*algorithm are selected as the comparison objects.In the case of a fixed starting position,a fixed ending position,and the same map,comparative experiments are conducted to analyze the algorithm.Finally,the planned path is transmitted to the UAV for actual flight verification.

    4.1. Simulation results

    In the simulation study,the parameters are selected as follows:the maximum yaw angle is 60°,the maximum pitch angle is 45°;the minimum relative height is 0.1 km;the minimum path length is 0.1 km;the initial heuristic weight coefficient is 1.3;the minimum grid length,width and height both are 0.1 km.

    First,on the mountain map 1 with the size of 64×64×64,the algorithm is used to search the path.In map 1,the first peak of mountain threat is (2 km,1.8 km,1.1 km),the second peak is(4.2 km,2 km,1.5 km),and the third peak is(3.5 km,4 km,2 km).Set the starting position of the UAV to(0.4 km,0.4 km,0.4 km),the ending position is(6 km,6 km,1.2 km).The path planned without the line-of-sight algorithm is shown in Fig.13,and the planned path with the line-of-sight algorithm is shown in Fig.14,where the black box is the sparse grid where the path node is located.The black line segment represents the path of UAV.

    Fig.13.Path without the line-of-sight algorithm in map 1.

    Fig.14.Path in map 1.

    Add threat area to map 1 to form map 2.The first center of the sphere threat area is (1.2 km,0.9 km,0.4 km),and the radius is 0.4 km;the second center of the sphere threat area is(1 km,3 km,0.5 km),and the radius is 0.5 km.The cylinder threat area is weather threat,the plane center coordinates are (4.7 km,5.3 km),the radius is 0.5 km,and the height is 1.5 km.The start and end position of the search are the same as before.The path planned without the line-of-sight algorithm is shown in Fig.15,and the planned path with the line-of-sight algorithm is shown in Fig.16.

    Fig.15.Path without the line-of-sight algorithm in map 2.

    Fig.16.Path in map 2.

    On the threat map 3 with the size of 64×64×64,the algorithm is used to search the path.In the map 3,the cylinder,sphere and cube are the threat area.Set the starting position of the UAV to(0.4 km,0.4 km,0.4 km),the ending position is(6 km,6 km,1.2 km),The planned path is shown in Fig.17.

    Fig.17.Path in map 3.

    On the mountain map 4 with the size of 128 × 128 × 128,the algorithm is used to search the path.In map 4,the first peak of mountain threat is (4 km,3.6 km,2.2 km),the second peak is(8.4 km,4 km,3 km),and the third peak is(7 km,8 km,4 km).Set the starting position to (0.8 km,0.8 km,0.8 km),the ending position is (12 km,12 km,2.4 km),and the planned path is shown in Fig.18.

    Fig.18.Path in map 4.

    In different maps,the information of the path planned by the improved lazy theta*algorithm is shown in Table 1.

    Table 1 Path data of different map.

    Table 2 Path data of different algorithm in map 1.

    From the visual results of different maps,the improved lazy theta* algorithm can effectively solve the problem of threedimensional path planning for UAV.The planned path can keep a safe distance from the obstacles because the obstacles are expanded.Due to the angle constraint in the algorithm,the yaw angle and pitch angle of UAV at the path node are less than the preset extreme value.Because the line-of-sight algorithm can delete redundant nodes,the number of nodes in the path is low.

    Analysis of the data in Table 1 shows that the following conclusions.When the terrain is complex,the octree map modeling time and path searching time will increase.When the grid map in three-dimensional space increases,the map modeling time increases and the path search time becomes longer,but the number of path nodes does not change much.Moreover,the octree map modeling in the algorithm requires a certain time.In practical applications,the octree map data can be directly imported into the algorithm,which saves the time of mapping modeling.

    4.2. Comparative simulation

    On the mountain map 1 with the size of 64 × 64 × 64,set the starting position of the UAV to(0.4 km,0.4 km,0.4 km),the ending position is(6 km,6 km,1.2 km).The ACO algorithm,improved ACO algorithm in Ref.[13],Improved RRT algorithm in Ref.[15],sparse A* algorithm,lazy theta* algorithm and improved lazy theta*algorithm are used to search the path,and the search time,the number of nodes and the length are recorded.

    On the mountain map 2 with the size of 64 × 64 × 64,set the starting position of the UAV to(0.4 km,0.4 km,0.4 km),the ending position is (6 km,6 km,1.2 km).The information of the path planned by different algorithm is shown in Table 3.

    Table 3 Path data of different algorithm in map 2.

    From the analysis of the data in Table 2 and Table 3,it is clear that ACO algorithm,improved ACO algorithm and improved RRT algorithm have poor performance,with long algorithm search time,high number of nodes and long length.This is due to the excessive number of path nodes searched by the algorithm.Sparse A* Algorithm has a short search time and a low cost,because it is highly suggestive and has few search nodes.The lazy theta*algorithm has a long search time,a small number of nodes,and a slightly shorter length.The lazy theta* algorithm is judged by the line-of-sight algorithm,and the intermediate node can be omitted,hence the number of nodes is small.By reducing the number of nodes,the algorithm also reduces the path searching time and path cost.The improved lazy theta*algorithm has short search time,short length and few nodes.The algorithm in this paper keeps the advantages of lazy theta* algorithm and further reduces the path cost by constructing octree map,which makes the path search time significantly reduced.

    4.3. Actual flight verification

    In order to verify the actual flight feasibility of the planned path,the DJI Matrice M600 Pro UAV is used as the platform.At the same time,the manifold 2 airborne computer is installed on the M600 Pro to make it have the function of automatic cruise.On the mountain map 2 with the size of 64 × 64 × 64,set the starting position of the UAV to(0.4 km,0.4 km,0.4 km),the ending position is(6 km,6 km,1.2 km).The planned path is shown in Fig.16.Since the M600 Pro UAV can only fly short distances,the length,width and height of the minimum grid will be set to 1 m when the UAV flies.The length,width and height of the minimum grid will be set to 100 m when drawing.The UAV and remote control equipment are shown in Fig.19.The flight diagram of UAV is shown in Fig.20.

    Fig.19.UAV and remote control equipment.

    Fig.20.The flight diagram of UAV.

    The Manifold 2 airborne computer receives the planned flight path and then performs actual flight verification.The path planned by the algorithm consists of a series of path nodes,which record the three dimensional coordinates of the position.For the whole path,a series of coordinate deviation are obtained by subtracting the coordinates of the previous node from the coordinates of the latter node.The coordinate deviation is continuously sent to the manifold 2 airborne computer as a flight command,and the UAV can fly along the planned path.The actual flight path is shown in Fig.21.

    Fig.21.Path in map 2.

    The actual flight distance and position deviation of the UAV are shown in Table 4.

    Table 4 Path data of actual flight.

    According to the visualization results and flight data,the deviation between the actual flight path and the planned flight path is small.The UAV can track the planned path well,which verifies the effectiveness of the algorithm.

    5.Conclusions

    (1) In this paper,an improved algorithm based on lazy theta*algorithm is proposed.The obstacle grid expansion is used to keep the UAV and the obstacle at a safe distance,and the octree data structure is used to build a map with fewer path nodes.lazy theta*is used to improve the speed of the search and the smoothness of the path.The neighbor node search,line-of-sight algorithm and heuristic weight adjustment are improved.Thus,the improved algorithm is successfully applied to the octree map,and the paths are finally planned.

    (2) Compared with the path planned by ACO algorithm,improved ACO algorithm in Ref.[13],Improved RRT algorithm in Ref.[15],the improved lazy theta*algorithm tends to search in the target direction when it searches nodes in the octree map.Therefore,the search speed is fast and there are fewer search nodes.At the same time,the node path cost is calculated when searching,and the path with less path cost can be obtained.Finally,the redundant nodes are deleted by the line-of-sight algorithm,which can make the path smooth and less expensive.Therefore,the improved lazy theta* algorithm can plan fast,smooth,safe and low cost paths.

    (3) The algorithm is a fast path planning method in threedimensional static environment.The position error of the algorithm in the UAV flight verification meets the requirements,so it can be applied to the military UAV mission planning system,which is conducive to the military UAV to perform various complex tasks and improve the combat capability.At the same time,the military UAV is facing sudden threats when performing tasks.It is necessary to quickly reconstruct the map and plan a new path.Octree map has the characteristics of real-time construction.And the algorithm has fast search speed and excellent search results.Therefore,the next step will study the online path planning method of military UAV in dynamic environment,includes establishing more effective map and threat model,optimizing the calculation function and actual flight verification.

    Declaration of competing interest

    The authors declare that they have no known competing financial interests or personal relationships that could have appeared to influence the work reported in this paper.

    Acknowledgements

    This work was supported in part by the National Natural Science Foundation of China under Grant U2013201 and in part by the Key R&D projects (Social Development) in Jiangsu Province of China under Grant BE2020704.

    欧美日本中文国产一区发布| 亚洲中文日韩欧美视频| 秋霞在线观看毛片| 亚洲精品久久成人aⅴ小说| 免费高清在线观看日韩| 日本wwww免费看| 日韩 欧美 亚洲 中文字幕| 久久天堂一区二区三区四区| 国产熟女欧美一区二区| 亚洲色图 男人天堂 中文字幕| 欧美精品人与动牲交sv欧美| 亚洲欧美中文字幕日韩二区| 黄色a级毛片大全视频| 亚洲欧洲国产日韩| 亚洲欧美一区二区三区黑人| 宅男免费午夜| 一区福利在线观看| 亚洲人成网站在线观看播放| 宅男免费午夜| 精品久久久久久久毛片微露脸 | av国产久精品久网站免费入址| 一级毛片我不卡| 老司机亚洲免费影院| 久久国产精品影院| 亚洲精品国产av蜜桃| 丁香六月天网| 国产精品国产av在线观看| 欧美激情极品国产一区二区三区| 久9热在线精品视频| 久久久久久久久免费视频了| 性色av一级| 亚洲成人国产一区在线观看 | 免费看av在线观看网站| 欧美日本中文国产一区发布| 日本色播在线视频| 亚洲欧美日韩高清在线视频 | 女人精品久久久久毛片| 51午夜福利影视在线观看| 亚洲中文av在线| 亚洲男人天堂网一区| av欧美777| 亚洲成人国产一区在线观看 | 美女福利国产在线| 我要看黄色一级片免费的| 国产黄色视频一区二区在线观看| 久久精品久久久久久久性| 国产深夜福利视频在线观看| 亚洲国产毛片av蜜桃av| 熟女av电影| 90打野战视频偷拍视频| 亚洲欧美一区二区三区黑人| 亚洲免费av在线视频| 极品人妻少妇av视频| 性高湖久久久久久久久免费观看| 亚洲av成人不卡在线观看播放网 | 一级毛片我不卡| 日本av手机在线免费观看| 精品卡一卡二卡四卡免费| 黄色视频在线播放观看不卡| 精品国产超薄肉色丝袜足j| 女人被躁到高潮嗷嗷叫费观| 国产亚洲欧美在线一区二区| 日韩大片免费观看网站| 亚洲国产精品成人久久小说| 国产午夜精品一二区理论片| 天天躁夜夜躁狠狠久久av| 成人三级做爰电影| 侵犯人妻中文字幕一二三四区| 人妻 亚洲 视频| 电影成人av| av一本久久久久| 国产黄色视频一区二区在线观看| 捣出白浆h1v1| 亚洲欧美成人综合另类久久久| 日韩一卡2卡3卡4卡2021年| 国产亚洲精品久久久久5区| 啦啦啦中文免费视频观看日本| av网站在线播放免费| 黄色a级毛片大全视频| 欧美精品啪啪一区二区三区 | 日韩大片免费观看网站| 国产麻豆69| 亚洲国产欧美在线一区| 久久久久精品国产欧美久久久 | 黄色a级毛片大全视频| 亚洲国产精品成人久久小说| 午夜两性在线视频| 在线观看人妻少妇| 国产伦理片在线播放av一区| 久久99一区二区三区| 亚洲人成电影免费在线| 国产男人的电影天堂91| 久久 成人 亚洲| 国产精品一区二区精品视频观看| 韩国精品一区二区三区| 亚洲国产精品999| 男女之事视频高清在线观看 | 中文字幕精品免费在线观看视频| 亚洲精品中文字幕在线视频| 精品国产一区二区三区四区第35| 久久精品人人爽人人爽视色| 大香蕉久久成人网| 精品欧美一区二区三区在线| 黄色毛片三级朝国网站| 97精品久久久久久久久久精品| av不卡在线播放| 99香蕉大伊视频| 伦理电影免费视频| 欧美日韩视频高清一区二区三区二| 午夜日韩欧美国产| 日韩一区二区三区影片| 欧美精品啪啪一区二区三区 | 亚洲综合色网址| 日日爽夜夜爽网站| 水蜜桃什么品种好| 国产亚洲av片在线观看秒播厂| www.av在线官网国产| 一区在线观看完整版| 在线观看免费高清a一片| 久久精品国产a三级三级三级| 国产亚洲精品久久久久5区| 精品久久蜜臀av无| 老司机影院成人| 国产av一区二区精品久久| 在线观看免费日韩欧美大片| 美女福利国产在线| 亚洲精品久久成人aⅴ小说| 亚洲av国产av综合av卡| 黄色毛片三级朝国网站| 日韩精品免费视频一区二区三区| 日韩大码丰满熟妇| 真人做人爱边吃奶动态| 精品视频人人做人人爽| 国产熟女午夜一区二区三区| 亚洲成人手机| 日韩欧美一区视频在线观看| 国产色视频综合| 99国产精品99久久久久| 少妇精品久久久久久久| 亚洲久久久国产精品| 搡老岳熟女国产| 久久国产精品人妻蜜桃| 爱豆传媒免费全集在线观看| 国产精品 欧美亚洲| 亚洲精品国产色婷婷电影| 最近手机中文字幕大全| 国产一卡二卡三卡精品| 欧美日韩视频精品一区| 亚洲自偷自拍图片 自拍| 一区福利在线观看| 人人妻人人澡人人看| 高清欧美精品videossex| 久久久精品免费免费高清| 后天国语完整版免费观看| 精品高清国产在线一区| 精品一区二区三卡| 如日韩欧美国产精品一区二区三区| 午夜福利视频精品| 午夜福利一区二区在线看| 嫁个100分男人电影在线观看 | 亚洲精品一区蜜桃| 中文字幕高清在线视频| av福利片在线| 精品欧美一区二区三区在线| 免费在线观看日本一区| 国产老妇伦熟女老妇高清| 日本91视频免费播放| 啦啦啦 在线观看视频| 99精品久久久久人妻精品| 色播在线永久视频| 亚洲欧美激情在线| 国产精品国产av在线观看| 一区二区三区精品91| 9色porny在线观看| 9热在线视频观看99| 精品亚洲成国产av| 成人亚洲欧美一区二区av| 亚洲黑人精品在线| 一本色道久久久久久精品综合| 一本大道久久a久久精品| 建设人人有责人人尽责人人享有的| 国产xxxxx性猛交| 国产精品国产av在线观看| 在线天堂中文资源库| 在线天堂中文资源库| 免费观看a级毛片全部| 国产精品一区二区免费欧美 | 美国免费a级毛片| 日韩中文字幕欧美一区二区 | 别揉我奶头~嗯~啊~动态视频 | 人人澡人人妻人| 精品一区二区三区av网在线观看 | av有码第一页| 别揉我奶头~嗯~啊~动态视频 | 在线观看免费午夜福利视频| 婷婷丁香在线五月| 色播在线永久视频| 国产亚洲一区二区精品| 天天躁夜夜躁狠狠躁躁| 麻豆乱淫一区二区| 亚洲av综合色区一区| 欧美 日韩 精品 国产| 美女午夜性视频免费| 国产欧美日韩一区二区三 | 少妇精品久久久久久久| avwww免费| 久久精品人人爽人人爽视色| 欧美在线一区亚洲| 午夜老司机福利片| av网站在线播放免费| 少妇猛男粗大的猛烈进出视频| 91老司机精品| 国产精品一区二区精品视频观看| 国产xxxxx性猛交| 高清视频免费观看一区二区| 制服诱惑二区| 久久久久国产一级毛片高清牌| 国产精品一区二区免费欧美 | 国产一级毛片在线| 成年动漫av网址| 黄色一级大片看看| 99香蕉大伊视频| 丰满迷人的少妇在线观看| 国产精品久久久久久精品电影小说| 国产免费又黄又爽又色| 成人免费观看视频高清| 满18在线观看网站| 各种免费的搞黄视频| 一区二区三区四区激情视频| 97精品久久久久久久久久精品| 午夜福利视频在线观看免费| 亚洲国产日韩一区二区| 美女大奶头黄色视频| 亚洲成国产人片在线观看| 女人爽到高潮嗷嗷叫在线视频| 欧美成人精品欧美一级黄| 日本黄色日本黄色录像| 色94色欧美一区二区| 精品免费久久久久久久清纯 | 国产精品国产三级专区第一集| 高清av免费在线| 下体分泌物呈黄色| 日韩欧美一区视频在线观看| 亚洲国产欧美一区二区综合| av片东京热男人的天堂| 看免费av毛片| 丁香六月欧美| 中文字幕亚洲精品专区| 老汉色av国产亚洲站长工具| 国产极品粉嫩免费观看在线| 91精品伊人久久大香线蕉| 精品亚洲乱码少妇综合久久| 黄频高清免费视频| 久久久久视频综合| 欧美日韩亚洲高清精品| 欧美成狂野欧美在线观看| 亚洲精品日本国产第一区| 岛国毛片在线播放| 午夜免费鲁丝| 少妇被粗大的猛进出69影院| 色综合欧美亚洲国产小说| 纯流量卡能插随身wifi吗| 老鸭窝网址在线观看| 精品久久久精品久久久| 在线天堂中文资源库| 精品一区在线观看国产| 一区二区日韩欧美中文字幕| 久久久国产一区二区| 亚洲国产精品国产精品| 在线观看免费午夜福利视频| 国产无遮挡羞羞视频在线观看| 高清黄色对白视频在线免费看| 中文字幕av电影在线播放| 国产精品久久久人人做人人爽| 一本色道久久久久久精品综合| 国产欧美日韩一区二区三区在线| 国产一区二区三区av在线| 亚洲国产精品成人久久小说| 国产精品九九99| 最新在线观看一区二区三区 | 亚洲一码二码三码区别大吗| 亚洲免费av在线视频| 久久国产亚洲av麻豆专区| 黄色视频在线播放观看不卡| 青春草视频在线免费观看| 日韩av在线免费看完整版不卡| 欧美国产精品一级二级三级| 日韩一区二区三区影片| 国产欧美日韩精品亚洲av| bbb黄色大片| 亚洲午夜精品一区,二区,三区| videosex国产| 亚洲精品av麻豆狂野| 亚洲视频免费观看视频| 欧美中文综合在线视频| 青春草视频在线免费观看| 亚洲av男天堂| 极品少妇高潮喷水抽搐| 亚洲欧美成人综合另类久久久| 妹子高潮喷水视频| 国产精品偷伦视频观看了| 水蜜桃什么品种好| 高清视频免费观看一区二区| 亚洲av成人精品一二三区| 99香蕉大伊视频| 电影成人av| 成人国产av品久久久| 国产精品香港三级国产av潘金莲 | 一区二区三区激情视频| 叶爱在线成人免费视频播放| 一级毛片我不卡| 女性生殖器流出的白浆| 黄片播放在线免费| 亚洲,欧美精品.| 美女扒开内裤让男人捅视频| 国产真人三级小视频在线观看| 桃花免费在线播放| 国产在线一区二区三区精| 欧美日韩一级在线毛片| 亚洲专区中文字幕在线| 亚洲欧美成人综合另类久久久| 免费在线观看影片大全网站 | 国产精品一区二区精品视频观看| 亚洲七黄色美女视频| 99久久99久久久精品蜜桃| 亚洲国产日韩一区二区| 日日爽夜夜爽网站| 91精品三级在线观看| 精品第一国产精品| 亚洲第一青青草原| 黄片播放在线免费| 久久久久精品人妻al黑| 亚洲情色 制服丝袜| 国产一卡二卡三卡精品| 欧美久久黑人一区二区| a级片在线免费高清观看视频| 国产精品三级大全| 热99久久久久精品小说推荐| 亚洲精品国产色婷婷电影| h视频一区二区三区| 精品欧美一区二区三区在线| 日韩电影二区| 亚洲精品国产一区二区精华液| 日本欧美视频一区| 国产亚洲欧美精品永久| 搡老岳熟女国产| 少妇的丰满在线观看| 丁香六月天网| 波多野结衣一区麻豆| 天天躁日日躁夜夜躁夜夜| 国产三级黄色录像| 亚洲情色 制服丝袜| 国产亚洲精品第一综合不卡| 国产麻豆69| av线在线观看网站| 操美女的视频在线观看| 男女午夜视频在线观看| 欧美黄色淫秽网站| 韩国精品一区二区三区| 性少妇av在线| 国产在线观看jvid| 国产一区亚洲一区在线观看| 美女午夜性视频免费| 777米奇影视久久| 搡老岳熟女国产| av又黄又爽大尺度在线免费看| 91成人精品电影| 国产成人91sexporn| 黑人巨大精品欧美一区二区蜜桃| av片东京热男人的天堂| 国产成人系列免费观看| 日韩中文字幕视频在线看片| 日本91视频免费播放| 国产精品亚洲av一区麻豆| 天天躁狠狠躁夜夜躁狠狠躁| 日韩av免费高清视频| 亚洲国产看品久久| 亚洲精品国产色婷婷电影| 久久久欧美国产精品| 男女国产视频网站| 亚洲国产精品999| 精品一区二区三区av网在线观看 | 久久久久久人人人人人| 日韩制服骚丝袜av| 精品亚洲成国产av| 一边亲一边摸免费视频| kizo精华| 久久久久久久精品精品| 成人亚洲精品一区在线观看| 久久精品国产综合久久久| 99精国产麻豆久久婷婷| 女性被躁到高潮视频| 亚洲一码二码三码区别大吗| 亚洲精品第二区| 国产黄频视频在线观看| 黄色 视频免费看| 日本午夜av视频| 纯流量卡能插随身wifi吗| 黄色片一级片一级黄色片| 嫩草影视91久久| 色婷婷av一区二区三区视频| 美女午夜性视频免费| 男女边吃奶边做爰视频| 欧美黑人欧美精品刺激| 在线观看免费高清a一片| 国产高清不卡午夜福利| 老司机亚洲免费影院| 老鸭窝网址在线观看| 秋霞在线观看毛片| 亚洲一卡2卡3卡4卡5卡精品中文| 老熟女久久久| 中文精品一卡2卡3卡4更新| 精品人妻在线不人妻| 伦理电影免费视频| 欧美日本中文国产一区发布| 91九色精品人成在线观看| 性色av乱码一区二区三区2| 亚洲国产精品成人久久小说| 免费人妻精品一区二区三区视频| 飞空精品影院首页| 日韩制服骚丝袜av| 精品一区二区三卡| 亚洲国产精品一区三区| 性高湖久久久久久久久免费观看| 又黄又粗又硬又大视频| 伊人亚洲综合成人网| 午夜两性在线视频| 久久精品久久久久久噜噜老黄| 97在线人人人人妻| 国产男女内射视频| 亚洲第一青青草原| 99国产精品99久久久久| 亚洲欧美精品自产自拍| 国产黄色视频一区二区在线观看| 国产一区二区三区av在线| 成年av动漫网址| 亚洲伊人久久精品综合| av欧美777| 久久热在线av| 大香蕉久久网| 我要看黄色一级片免费的| 美女大奶头黄色视频| 韩国高清视频一区二区三区| 国产国语露脸激情在线看| 午夜福利视频在线观看免费| www.熟女人妻精品国产| 精品少妇黑人巨大在线播放| 大片免费播放器 马上看| 香蕉丝袜av| a级毛片黄视频| 一区二区三区精品91| 久久久久久久国产电影| 一本色道久久久久久精品综合| 日韩欧美一区视频在线观看| 久久精品久久精品一区二区三区| 成人亚洲欧美一区二区av| 国精品久久久久久国模美| 热99久久久久精品小说推荐| 久久青草综合色| 亚洲av电影在线进入| 欧美人与性动交α欧美软件| 久久久国产一区二区| 精品一品国产午夜福利视频| 久久久久久久久免费视频了| 精品久久久久久久毛片微露脸 | 丝袜在线中文字幕| 欧美黄色淫秽网站| 久久天堂一区二区三区四区| 在线观看免费高清a一片| 精品免费久久久久久久清纯 | 日本vs欧美在线观看视频| 日韩电影二区| 亚洲精品久久午夜乱码| 中文字幕人妻丝袜制服| 久久人人爽人人片av| 日韩伦理黄色片| 在线观看人妻少妇| 搡老乐熟女国产| 日韩熟女老妇一区二区性免费视频| 又黄又粗又硬又大视频| 欧美激情高清一区二区三区| 无限看片的www在线观看| 美女脱内裤让男人舔精品视频| 中文字幕高清在线视频| 黄色一级大片看看| 国产高清videossex| 一个人免费看片子| 少妇人妻久久综合中文| 亚洲专区中文字幕在线| 久9热在线精品视频| 在线观看www视频免费| 久久精品成人免费网站| 一二三四在线观看免费中文在| 人成视频在线观看免费观看| 老司机亚洲免费影院| 国产免费福利视频在线观看| 久久精品国产综合久久久| 亚洲人成77777在线视频| av在线播放精品| 欧美黑人欧美精品刺激| 国产精品一区二区免费欧美 | 国产欧美日韩精品亚洲av| 50天的宝宝边吃奶边哭怎么回事| 蜜桃在线观看..| 久久午夜综合久久蜜桃| 国产精品国产av在线观看| 国产高清videossex| 国产伦理片在线播放av一区| 欧美日韩国产mv在线观看视频| 美女大奶头黄色视频| 久久久久久久大尺度免费视频| xxx大片免费视频| 国产精品二区激情视频| 欧美 亚洲 国产 日韩一| 日韩大码丰满熟妇| 极品少妇高潮喷水抽搐| 国产日韩一区二区三区精品不卡| 国产av精品麻豆| 亚洲欧美精品综合一区二区三区| 国产成人av教育| 青春草视频在线免费观看| 一级毛片女人18水好多 | 精品国产超薄肉色丝袜足j| 亚洲av男天堂| 欧美黄色片欧美黄色片| 丰满少妇做爰视频| 嫁个100分男人电影在线观看 | 亚洲欧洲精品一区二区精品久久久| 岛国毛片在线播放| 老司机在亚洲福利影院| 久久精品久久久久久噜噜老黄| 日韩精品免费视频一区二区三区| 亚洲精品av麻豆狂野| 交换朋友夫妻互换小说| 亚洲 国产 在线| √禁漫天堂资源中文www| 国产三级黄色录像| 国产精品一区二区精品视频观看| 亚洲欧洲国产日韩| 国产又色又爽无遮挡免| 9191精品国产免费久久| 国产精品国产三级专区第一集| 亚洲少妇的诱惑av| 激情五月婷婷亚洲| 国产av精品麻豆| 国产精品一二三区在线看| 久久久久久亚洲精品国产蜜桃av| 一本一本久久a久久精品综合妖精| 国语对白做爰xxxⅹ性视频网站| 国产一区有黄有色的免费视频| 伦理电影免费视频| 黑丝袜美女国产一区| 国产亚洲av高清不卡| 一区二区av电影网| 久久久精品免费免费高清| 精品高清国产在线一区| 中国美女看黄片| 精品亚洲乱码少妇综合久久| 久久午夜综合久久蜜桃| 亚洲九九香蕉| 免费看av在线观看网站| 中文精品一卡2卡3卡4更新| 亚洲国产日韩一区二区| 下体分泌物呈黄色| 国产成人av教育| 91麻豆精品激情在线观看国产 | 国产免费又黄又爽又色| 久久国产亚洲av麻豆专区| 日韩av不卡免费在线播放| 女人高潮潮喷娇喘18禁视频| 91老司机精品| cao死你这个sao货| 日韩制服丝袜自拍偷拍| 久久国产精品人妻蜜桃| 亚洲七黄色美女视频| 午夜精品国产一区二区电影| √禁漫天堂资源中文www| 蜜桃在线观看..| 国产成人av激情在线播放| 亚洲精品美女久久av网站| 在线观看免费高清a一片| 中文字幕另类日韩欧美亚洲嫩草| 国产精品99久久99久久久不卡| 午夜老司机福利片| 久久av网站| 久久久久网色| 亚洲国产av新网站| 高清视频免费观看一区二区| 美女国产高潮福利片在线看| 午夜老司机福利片| 国产伦理片在线播放av一区| 五月天丁香电影| 国产成人一区二区三区免费视频网站 | 亚洲中文av在线| 国产亚洲av高清不卡| 久久久久国产一级毛片高清牌| 五月开心婷婷网| 欧美成人午夜精品| 亚洲综合色网址| 波野结衣二区三区在线| 久久久久久免费高清国产稀缺| 高清av免费在线| 国产av精品麻豆| 晚上一个人看的免费电影| 亚洲精品国产色婷婷电影| 天堂中文最新版在线下载| 伊人久久大香线蕉亚洲五| 国产日韩一区二区三区精品不卡| 国产成人精品久久二区二区91| av线在线观看网站| 色视频在线一区二区三区| 亚洲国产欧美一区二区综合| 免费黄频网站在线观看国产| 免费一级毛片在线播放高清视频 | 男女边摸边吃奶|