The invention relates to airplane flight path planning and to multiple attribute decision making technology. More specifically, the invention relates to a flight path planning method and device based on the pigeon-inspired optimization method.
Path planning is the process of determining a collision-free pathway between the current position of an unmanned aerial vehicle (“UAV”) and its destination. Researchers have been studying how to generate collision-free paths for vehicles in obstacle environments, which is critical for autonomous vehicles.
According to certain evaluation standard systems, path planning is: within a given planning space, finding the optimal and feasible flight path of the body movement from the starting point to the target point while satisfying certain constraint conditions and a certain performance index such that the movement of body safely accomplishes a predetermined task. Due to the movement of the aircraft, airplane flight path planning is complex under the complicated environment of the task. The path planning system needs to comprehensively consider the aircraft maneuverability, task time and terrain factors such as environment and enemy control area. Mathematically speaking, the aim of path planning is to find the optimal solution under many constraints.
The multi-objective optimization problem (MOP) brings multiple conflicting objectives. The essential difference between MOP and a single objective optimization problem is that in most cases of MOP, the improvement of an objective may negatively influence other objectives. Achieving the best performance of all the multiple objectives at the same time is impossible, as the optimum can only be achieved by proper coordination and compromising between the objective functions as far as possible.
The present existing aircraft flight path planning technology does not consider uncertainty conditions, such as wind, angle change, starting and end points of the operation, etc., resulting in a poor stability of the path planning procedure. Also, the UAV may deviate from the pre-planned path due to the error of the sensor on it and the inertia of its own motion. With a slight deviation, the pre-planned path might not be easily adapted. The UAV may need to replan its path from its current position to the destination, and path replanning could lead to unnecessary time consumption. Therefore, it is necessary for flight path planning to take uncertain conditions into consideration.
Pigeon-inspired optimization (“PIO”) algorithm was first proposed by Prof. Duan Haibin in 2014. The PIO algorithm, compared to other bionic intelligent optimization algorithms, possesses parallelism in searching process, feasibility and characteristics of strong robustness, so it can be used to solve complex optimization problems in succession.
PIO is a novel swam intelligence optimizer for solving global optimization problems. It is based on the natural behavior of pigeons. The migration of pigeons is described with two mathematical models. One is a map and compass operator, and the other one is a landmark operator. In the first half of the algorithm calculation, the map and compass operator is utilized, whereas the landmark operator is used in the second half.
The switch of these operators is used to simulate the process of pigeon navigation. When pigeons are far from their destination, they use the earth magnetic field to adjust the direction. The magnetic field can be abstracted as map and compass operator. As they fly towards their destination, they rely more on landmarks along the way, which are abstracted as landmark operator.
Since the discovery of small-world phenomenon by Watts and Strogatz and scale-free property by Baraba'si and Albert a decade ago, it has been realized that most real networks are neither fully connected networks nor homogeneous regular networks, but of small-world and scale-free topological characteristics. In this paper, the pigeon-inspired optimization algorithm considers the topological characteristics. The movement of pigeons in the optimization process can be regarded as a dynamic network. Much evidence has demonstrated that the structural properties play key roles in dynamical processes taking place on complex networks. Previous findings prompt us to wonder how scale-free topology that captures the interaction pattern among pigeons affects the PIO and if scale-free topology can offer better performance of the optimization process. To answer these questions, the present invention has incorporated scale-free topology into the pigeon-inspired optimization in an attempt to improve the optimization process with respect to its solution quality and convergence efficiency. We have found that the scale-free topology that captures the diversity of individuals leads to the balance between the solution quality and the convergence efficiency, which outperforms the traditional pigeon-inspired optimization algorithm based on either fully-connected graph or regular graph.
The purpose of the present invention is to provide a flight path planning method and device based on an intelligent optimization algorithm, especially considering the uncertainties of the route optimization problem. Compared with the ordinary path planning algorithm, the present invention takes into account the influence of the uncertainties so as to achieve higher path stability.
Note that the following description applies to airplanes in general, including but not limited to UAVs. When the term “UAV” is used in the description, it is only intended as an example and not a limitation.
Firstly, given the regional environment information provided by an airborne sensor, a trajectory prediction model generates the initial path using a traditional path planning algorithm. Secondly, an uncertainty prediction model is established. Thirdly, an initial path including uncertainty is determined, which is set as a preliminary solution to be optimized. Finally, by using a path optimization algorithm, an optimal path is obtained and executed by a flight controller onboard.
The steps of establishing the uncertainty prediction model are described in the following section.
Suppose there are K number of points that can change the course angle between the starting point and destination point within a specific area, the changes of course angle are expressed as θ1, θ2, . . . , θK, then the whole flight path or flight trajectory consists of K+1 path sections, with their lengths defined as d0, d1, . . . , dK, so the aircraft trajectory path function is described by:
Once the changes of course angle and the lengths of path sections are calculated, N path points (p1, p2, . . . , pn) are determined, with p1, pn being the starting and destination points respectively of the flight path. In terms of quantity, n=K+2.
As shown in
where rij represents the shortest distance between a path point ellipse and the threat center j and rsafe denotes the safe distance of the threat center.
The fitness function is described as follows: min ƒcost=wƒL+(1−w)ƒTA
where w is a weight coefficient.
The constraint conditions are as follows: the value of each course angle change θ1, θ2, . . . , θK−1 has a set range; each path length has a minimum step size L and a set upper limit; d0, d1, . . . , dK−1, θ1, θ2, . . . , θK−1 cannot be 0; rij≥rsafe
According to the established trajectory prediction model, an optimal path is obtained by using an intelligent optimization algorithm, followed by the output d0, d1, . . . , dK−1, θ1, θ2, . . . , θK−1.
The present invention provides an aircraft track planning device, which, as shown in
(a) an access module for getting the regional environment information;
(b) a building module having one or more building blocks for setting up a trajectory prediction model and an uncertainty prediction model;
(c) a determining module, which utilizes the trajectory prediction model and the uncertainty prediction model to determine the trajectories to be optimized;
(d) an optimization module, which uses the improved pigeon-inspired optimization algorithm to optimize the trajectories; and
(e) a storage module for storing the parameters of the optimal path.
In (a), the function of the access module is established with the help of sensors, including a GPS device and infrared sensors. The location of start point, end point, and the airplane's or UAV's current position are provided by GPS. The infrared sensors can help the airplane or UAV locate threats or obstacles along the way.
In (b), (c), (d) and (e), the calculation and storage can be performed by the flight controller onboard, which is known as the brain of UAV
The advantages of the invention are the ability to consider uncertainties during route optimization procedures and to improve path robustness and feasibility.
Combining scale-free network and the PIO algorithm is also an innovative feature of the present invention, which helps the optimization algorithm converge faster and escape from local optima. To sum up, compared with the traditional PIO algorithm, the efficiency and quality of path planning have been improved.
In the PIO algorithm, pigeons can be seen as nodes in the network, and pigeon population represents the network size. The much better performance of the invention is attributed to the cooperation between hub nodes and non-hub nodes in the network, where the former is of strong ability to ensure high solution quality and guides the evolution direction, while the latter helps maintain the activity of the population for exploring the solution space and escaping from local optima. The invention suggests the paramount importance of exploiting the diversity in population for achieving better evolution pattern of pigeons, which has many implications in computational intelligence and controlling a variety of dynamical processes. The invention proposes a method, in which scale-free network that incorporates the diversity of individuals is exploited to better mimic the real situation and improve the traditional PIO.
The invention will now be further described using the accompanying drawings and examples.
According to the uncertainty prediction model, the prediction of the next flight moves takes different sources of uncertainty into account, such as wind, course angle change, operation starting and end points, sensor error, motion inertia, etc. Afterwards, an improved pigeon-inspired optimization (“PIO”) algorithm is used to generate an optimal path.
In this invention, an uncertainty prediction model is established, which improves path robustness and feasibility. To better illustrate this model, an example is given below. Suppose the initial path points and course angle changes are as shown in
As seen in
The variables d0, d1, d2, α, β with their corresponding uncertainty parameters ϵ0, ϵ1, ϵ2, ϵα, ϵβ have the upper limit of d0max, d1max, d2max, αmax, βmax, respectively. The shortest distance from the starting point O to the destination point D is defined as dmin. With m threat centers within the region, the aircraft's flight path points are represented by p0, p1, . . . , pn, pn+1, with p0, pn+1 being the starting and destination points respectively of the aircraft's flight path. Each path point has an elliptical convex hull describing the position uncertainty of the aircraft.
The following section covers the process of obtaining the equation which describes the uncertainty prediction model:
Utilizing the coordinates of the starting and end points yields
and the slope of line OD is
The coordinates of point A (x1, y1) are given by
and the slope of line AB is k2=tan (α+γ).
The coordinates of point B (x2, y2) are given by
and the slope of line BC is k3=tan (α+β+γ).
The coordinates of point C (x3, y3) are given by
The distance d3 between point C and the destination point is given by d3=√{square root over ((x4−x3)2+(y4−y3)2)}.
The aircraft trajectory path function ƒL and the cost ƒTA of the aircraft's flight path caused by the threat centers are defined as
ƒL=(d0+d1+d2+d3)2;
According to these four functions, we build a fitness function:
min ƒcost=wƒL+(1−w)ƒTA
Constraint conditions are as follows:
−αmax≤α≤αmax,
−βmax≤β≤βmax,
L≤d0≤d0max, L≤d1≤d1max, L≤d2≤d2max;
d0, d1, d2, α, β all are nonzero;
rij≥rsafe;
The weight coefficient w ranges from 0 to 1 and the minimum step size L changes the flight route around a corner using the shortest way possible.
As shown in
The method for planning a flight path of an aircraft based on the pigeon-inspired optimization algorithm of the present invention may include the steps as shown in
Step 1: Given the environment information provided by sensors in the access module, model the flying environment of the UAV.
Step 2: Establish initial path points with the help of the trajectory prediction model and the uncertainty prediction model of the building module.
The trajectory prediction model utilizes Rapidly-exploring Random Trees algorithm (RRT) to generate a coarse path from the starting point O to the destination point D. The benefit of RRT algorithm is its fast calculation speed and simple implementation. Path planning process includes two parts: path generation and path optimization. Using RRT algorithm in the generation part will save more time for optimization. Also, taking uncertainty into consideration helps improve path stability. Although the quality of the initial path is not good enough, it will be improved in the optimization part. The position information of initial path points is recorded by the storage module.
Step 3: set the fitness function for the position matrix (to be described in Step 4 below).
With the trajectory prediction model and the uncertainty prediction model, the present invention is to solve the minimization problem, for which the objective function is expressed as
where ƒmin(X) is the fitness function min ƒcost=wƒL+(1−w)ƒTA and X stands for a particular path, and ϵ is a given small number to avoid the value of the denominator being zero.
Step 4: Initialize PIO algorithm parameters with the help of scale-free network.
In the initialization, the pigeon population Np, the dimension D of the solution search space, the maximum number of iterations for map and compass operator T1, the maximum number of iterations T, the geomagnetic factor R in the map and compass operator and landmark factor q are initialized. The dimension D of the solution search space includes the information about angle change and the distance of every path point.
Pigeon flock can be seen as a scale-free network because of its dynamically changing property. Introducing the characteristic of a scale-free network can make the optimization process converge faster. The size of the network is same as the pigeon population Np. The size of the network is grown from 1 to Np. A pigeon or a node represents a path solution. There are two main features of scale-free network: continuous growth and preference connection. The initial node at the beginning of network growth is set according to initial path points in the storage module. In the process of generating the network, new nodes follow the preference connection, which means that new nodes have a greater probability of connecting to nodes with a higher degree. degj represents the degree of j-th node in the network. The degree of a node is the number of edges connected to the node.
Based on the scale-free network model, an Np×D initial position matrix and an Np×D initial velocity matrix are randomly generated. Every path solution is expressed as a row vector in the position matrix. Assume that there are K path points between the starting point O and the destination point D, at which the course angle may change, the row vector can be expressed as (d0, d1, . . . , dK−1, θ1, θ2, . . . , θK−1), where (d0, d1, . . . , dK−1) represents flying distance from one path point to the next path point except the destination point D, and (θ1, θ2, . . . , θK−1) represents course angle changes of the UAV at each of the path points except the path point immediately preceding the destination point D. With the information above, the path can be determined.
Step 5: apply map and compass operator to update the velocity and position of each pigeon in the velocity matrix and in the position matrix, respectively;
In the PIO model, virtual pigeons are used. In the map and compass operator, the rules are defined with the position Xi and the velocity Vi of pigeon i. The velocity matrix and position matrix are updated in each iteration.
Firstly, use the fitness function to calculate the position matrix and find the node with minimum fitness value. This node is set as the central node. The degree of the central node is set as degc. Xself,i denotes the position of i-th node with minimum fitness value in its iteration history. Xlocal,i denotes the position with minimum fitness value among i-th node and its neighbor nodes.
When updating the position matrix and velocity matrix, it is necessary to compare the degree of i-th node degi and the degree of the central node degc.
If degi≥degc, the velocity of i-th node at t-th iteration is updated though the following equation:
V
i
t
=V
i
t−1
e
−Rt
+r
1(Xself,it−Xit−1)
If degi<degc, the velocity of i-th node at t-th iteration is updated though the following equation.
V
i
t
=V
i
t−1
e
−Rt
+r
1(Xlocal,it−Xit−1)
In the two equations above, R is the geomagnetic factor, r1 is a random number ranging from 0 to 1, and Vit−1 is the velocity of i-th node at (t−1)-th iteration.
The central node is the current best position. In this minimization problem, all the nodes attempt to move close to the central node for lower fitness value. However, for those nodes with many connections, the more nodes connected, the greater the impact on the entire network when the change occurs. Therefore, these nodes need to make minor self-updates to avoid unnecessary oscillation in the network which may increase the optimization time.
On the other hand, nodes with few connections can make updates much more straightforwardly. As shown in
When we get the updated velocity, we can further update the position matrix,
X
i
t
=X
i
t−1
+V
i
t
where Xit and Vit are the position and velocity of i-th node at t-th iteration, Xit−1 is the position of i-th node at (t−1)-th iteration.
If the current iteration number has not reached T1, then continue Step 5.
Step 6: perform landmark operations, sort all pigeons according to fitness values, lower-adapted pigeons follow the adapted pigeons and find the center of the flock (destination), all pigeons will fly directly to their destination.
Perform landmark operation when current iteration number t satisfies T1<t≤T. In the landmark operation, the node with the smallest degree is deleted, that is, the row vectors corresponding to the node in the position matrix and the velocity matrix are set to zeros. As shown in
where q is the landmark factor, r2 is a random number ranging from 0 to 1, and fitness value is the quality of the individual pigeon. For the minimization problem, the objective function is expressed as
where ϵ is a given small number to avoid the value of the denominator being zero.
As shown in
If the iteration number has not reached T, then repeat Step 6.
Step 7: Determine whether the maximum number of iterations T is reached. If the iteration is finished, the row vector corresponding to the center node in the remaining nodes in the position matrix represents the final optimal planned path. And then record optimal path data in the storage module. Data includes distances between path points and course angle changes.
Step 8: Flight controller onboard guides the UAV to move according to planned path points.
Correspondingly, the aircraft track planning device based on the pigeon-inspired optimization algorithm according to the present invention, as shown in
The access module is used to obtain the environment information in the specified area, mainly including the starting point and destination point in the specified area, the obstacle information, and the like. The function of the access module is established with the help of several hardware pieces, including a GPS device and infrared sensors. Using GPS, the location of the starting point and ending point is determined. The location of obstacles in the environment is provided by infrared sensors onboard. As seen in
The building module contains trajectory prediction model and uncertainty prediction model. The process of building trajectory and calculating uncertainty is not repeated here.
The determining module is configured to determine an initial path to be optimized according to the environment information and models in the building module.
The optimization module is used for optimizing the path to be optimized by the improved pigeon-inspired optimization algorithm. The PIO algorithm with scale-free network, shown in
The storage module is used to store the parameters of the optimal path in a computer memory. The parameters include flying distance from one path point to the next path point d0, d1, . . . , dK−1, and course angle changes of the UAV at each path point θ1, θ2, . . . , θK−1. In the process of path planning, parameters of initial path points generated by the determining module are stored, and also parameters for the optimal path points are stored for execution. Also, geospatial data including the location of the start point, the destination, and threat centers need to be stored in the storage module.
The calculation, storage, and UAV motion control in modules above is implemented on the flight controller, which can be seen as the brain of UAV. The flight controller contains two parts: Micro Controller Unit (MCU) and Inertia Measurement Unit (IMU). MCU provides storage space and computing software for optimized algorithm. In current days, MCU generally adopts STM32 series microprocessors with 32-bit ARM architecture. These microprocessors can sufficiently fulfill MCU's requirement for storage and computation. IMU is utilized to do motion tracking, which means sensing and recording the flight attitude and motion state. With the help of flight controller, the UAV can navigate safely and efficiently from the start to the destination.
Number | Date | Country | Kind |
---|---|---|---|
201710625878.8 | Jul 2017 | CN | national |
This application is a continuation-in-part of U.S. application Ser. No. 16/048,206 filed Jul. 27, 2018, which claims priority of China Patent Application No. 201710625878.8 filed Jul. 27, 2017. The entirety of each of the said applications is incorporated herein by reference.
Number | Date | Country | |
---|---|---|---|
Parent | 16048206 | Jul 2018 | US |
Child | 17033785 | US |