Research Article | Open Access

Wang Jian-hong, Rana Javed Masood, "Interior Point Algorithm for Multi-UAVs Formation Autonomous Reconfiguration", *Journal of Control Science and Engineering*, vol. 2016, Article ID 9095372, 9 pages, 2016. https://doi.org/10.1155/2016/9095372

# Interior Point Algorithm for Multi-UAVs Formation Autonomous Reconfiguration

**Academic Editor:**Michela Robba

#### Abstract

Here the problem of designing multi-UAVs formation autonomous reconfiguration is considered. Combined with three kinds of cost functions, nonlinear dynamic equations, and four inequality constraints, one nonlinear multiobjective optimization problem is constructed. After applying weighted sum method and separating all equality or inequality constraints, the former nonlinear multiobjective optimization problem can be converted into a standard nonlinear single objective optimization problem. Then the interior point algorithm is applied to solve it. Further some improvements are proposed to avoid rank deficiency of some matrices. The equivalence property between multiobjective optimization and single objective optimization through weighted sum method is proved. Finally the efficiency of the proposed strategy can be confirmed by the simulation example results.

#### 1. Introduction

Multi-UAVs formation is the basis and prerequisite for the UAV mission. When formation task or battlefield environment changes with time, the entire multi-UAVs formation needs to be adjusted. This adjustment is called formation autonomous reconfiguration. In reconfiguration process, each UAV adjusts its own position as a new geometry and plans the flight trajectory from the original location to the new terminal location. Thus the planned flight path ensures each UAV is secure while considering the nonlinear dynamics of UAV, various formations cost function, and a variety of constraints. So multi-UAVs formation autonomous reconfiguration is designed as a mathematical optimization problem in which decision variables are the control input sequences. The cost functions include three kinds of functions such as investigation UAV cost function, interference drone missile costs function, and radar jamming UAV cost function. Moreover the constraints include radar threat constraint, missile threat constraint, artillery positions constraint, and formations anticollision constraint.

An overview about the auxiliary role of the multi-UAVs formation trajectory design in a cooperative investigative process is given in [1]. In [2] an intelligent multiagents system is introduced and this multiagent system is represented as the communication structure between various UAVs. In [3] descriptions of many various methods of UAV path planning are summarized. In [4] the weights which exist in many intelligent algorithms are adjusted based on the gray system theory. In [5] the methods about how to fuse the multiple sensor information are analyzed to obtain state estimates from the perspective of information fusion. In [6] the particle filter algorithm is applied to track path under the non-Gaussian condition. In [7] one interacting multiple model algorithm based on particle filter is proposed. In [8] the ant colony algorithm from the multiobjective optimization is studied. In [9] one consensus genetic algorithm is used to solve the multiobjective optimization problem. In [10] the use of game theory can transform the original multiobjective optimization problem into a Nash bargaining process. In [11] the communication delay is considered and one information compensated method based on the information filter algorithm is presented.

Here the interior point algorithm is applied in multi-UAVs formation autonomous reconfiguration to design the autonomous trajectory. In the optimization model, three different cost functions are established and the dynamic equations of each UAV are regarded as equality constraints. After combining radar threats, missile threat, artillery positions threat, and formations anticollision, four kinds of inequality constraints are obtained. Based on these cost functions and equality and inequality constraints, an multiobjective optimization problem with equality and inequality constraints is constructed. The multiobjective optimization problem is solved to obtain the control input sequences which are used to plan trajectory. The main contribution of this paper is to analyze this multiobjective optimization problem by using operations algorithm. For this multiobjective optimization problem, the weighted sum strategy is applied to transform that multiobjective optimization into a single objective optimization and the feasibility of the weighted sum strategy is proved theoretically. In order to rewrite the original optimization problem into a standard form of nonlinear optimization, the kinetic equation for each equation UAV is further expanded and some forms are used to describe the set of state variables and control inputs. For the standard nonlinear optimization form, the major steps of the proposed interior point algorithm are given here. After calculating the optimal input sequences of nonlinear optimization problem by using the interior point algorithm, the idea of nonlinear receding horizon predictive control can be introduced. This idea is to choose the first term in the obtained optimal control input sequence and discard the remaining terms.

#### 2. Multi-UAVs Formation Autonomous Reconfiguration

Multi-UAVs formation autonomous reconfiguration means that at initial time instant, multiple UAVs fly in a formation pattern. When the battlefield environment changes with time, the UAV swarm adjusts each UAV’s former formation pattern and chooses one new flying pattern independently. In formation reconstruction processes, each UAV’s position in the new formation mode requires to be redesigned in order to produce a new flight path. During the process of designing new flight path, the dynamics of each UAV, flight cost function, and constraints are considered. Multi-UAVs formation autonomous reconfiguration process is shown in Figure 1, where four different formation modes are described. It means that the groups of multiple UAVs sequentially select their own new formation modes according to the different surrounding environment.

Assume there are UAVs flying in formation, and the length of time is . Since each UAV is decoupled with each other, this assumption means dynamic coupling phenomenon does not exist. Set state vector of the UAV as follows:The control input sequence is thatThe time invariant discrete time state space equation is given asIn (3), is a nonlinear mapping; this nonlinear mapping combines the state vector at time and control input vector to predict one new state variable at the next time instant ; and are the feasible state set and control input constraint set with respect to the UAV.

The main contribution of this paper is to study how to transform the multiobjective optimization problem into a standard nonlinear optimization problem, and the classical interior point algorithm is applied to analyze the equivalence between the multiobjective optimization and single objective optimization by using weighted sum strategy.

When UAV formation leaps across the battlefield environment, there are many methods to define the cost function. For example, here define the position of the virtual lead aircraft at time asThe position of UAV whose role is to carry out the reconnaissance mission is denoted asThe cost function corresponding to UAV during the whole reconnaissance mission is defined asIn (6), represents a positive definite weighting matrix; the second term is used to normalize the original optimization problem and ensure that the optimal solution will not depart the true solution. Similarly two other cost functions coming from the missile and radar interference are given:In (7), the cost function is constructed by the distance between the current position and ideal position of the missile interference that interferes the UAV. is the ideal position of the missile interference. In (8), the cost function is constructed by the distance between the current position and ideal position of the radar interference that interferes the UAV. This cost function can achieve the maximum protection under formation flight path.

In total there are UAVs lying in the formation geometry. Combining (6), (7), and (8), we consider the following cost function:In (9), the total number of elements in the minimization operation is . The minimum solution which guarantees all elements can achieve their own minimization simultaneously does not exist. Fortunately one compromise solution can be found and this compromise solution is called the efficient solution in multiobjective optimization theory. Under not any constraints, the optimization problem (9) can be solved by the weighted sum strategy. But in multi-UAVs formation autonomous reconfiguration problem, four kinds of inequality constraints are considered; the interior point algorithm can only be used to get an efficient solution.

All kinds of constraints include the radar threat constraint, missile threat constraint, artillery positions threat, and formations anticollision constraint. Their respective inequalities are defined as follows in turn.

Setting the position and detection radius of the radar as and , respectively, then the radar threat constraint corresponding to the UAV is defined as follows:Setting the position of missile as , the safety distance and safety angle cosine after disturbing missile are and , respectively. Then missile threat constraint corresponding to the UAV is defined as follows:Assuming that the radiation radius of artillery positions is not influenced by external disturbance, we set this radiation radius as a constant. The position and radiation radius of artillery are defined as and , respectively; then artillery positions threat corresponding to the UAV is defined as follows:The minimum safe distance among UAV formation is denoted by , and then formations anticollision constraint corresponding to the UAV is defined as follows:Unifying the above multiobjective function (9), nonlinear dynamical equations (3), and four inequality constraints (10)–(13), multi-UAVs formation autonomous reconfiguration problem can be formulated as a nonlinear multiobjective optimization problem:Combining all the inequality constraints in (14) and vectoring them, we getwhere the state variable and control input vector are given, respectively, as follows:Similarly combining all the nonlinear dynamics equations of each UAV, we getUsing the vector form (15), (16), and (17), nonlinear multiobjective optimization problem can be simplified asBefore solving (18) by the interior point algorithm, we transform the multiobjective optimization problem (18) into a nonlinear optimization problem with equality and inequality constraints.

#### 3. Standardized Model

In (18), the cost function is a multiobjective vector:Applying the weighting sum strategy and transforming to one single objective optimization problem,In (20), vector indicates positive weighted scalar values and the following conditions are satisfied:The nonlinear dynamic equations of UAV (18) can be rewritten as follows:In (22), the first equation represents the initial state. For the set of feasible state and control input constraint set , define the following constraints:The two above functions and do not depend on two variables and simultaneously.

Combining all the equations and inequalities together and using (20), we obtain a standard nonlinear optimization problem:In order to solve the standard nonlinear optimization problem (20), the interior point algorithm is proposed.

#### 4. Interior Point Algorithm

The purpose of the interior point algorithm is to generate an iterative sequence ; here the superscript symbol is different with control input at time instant . This generated sequence will be included in the control input set. In the iteration process of each generating sequence, each element of the inequality constraint is considered. After introducing the slack variable , those inequality constraints can be converted into equality constraints [12]. The standard nonlinear optimization problem (24) can be rewritten asIn (25), the slack variable is chosen as a vector with appropriate dimension, and each of its elements is nonnegative. Then we construct one Lagrangian function corresponding to (25) as follows:According to the necessary condition from the optimality theory, the equation holds at the minimum value.

Applying the optimality Karush-Kuhn-Tucker sufficient and necessary condition [13], we obtainFrom (27), we have thatIn (27), define the following two matrices:In (27), the introduction of perturbation parameter is to guarantee that if we choose , the iteration sequence will be far away from the boundary of the control input set. The choice of the perturbation parameters satisfies thatIn order to improve the performance of the optimal conditions (27), we use the interior point algorithm to solve (25) and introduce barrier function to eliminate the nonnegative condition :The barrier function is added here to prevent each element of slack variable to approach 0 closely. Also applying the generalized optimality KKT sufficient and necessary condition [14] in (31) with one barrier function, we obtainUsing Newton increment steps in (32), we obtain the following system equation:After calculating the increment,The new recursive iteration values are calculated aswhere two steps and are chosen aswhere , and take . To ensure the second block matrix in (33) has full row rank and this matrix is not singular, we rewrite (33) as follows:where , as in the iterative process, the normed function is a decreasing function. It means that the incremental vector is a descent direction, so it is desirable to choose matrixas a positive definite matrix which is on the null space with respect to matrix From the construction of , it means is a positive definite matrix. But Hessian matrix may be negative definite. To compensate for this defection, we use to replace Hessian matrix . Scalar is chosen sufficiently large to ensure the positive definiteness of the Hessian matrix. Additionally in the interior point algorithm, the rank deficiency of the gradient matrix is considered. So we make the following modifications to the primal-dual matrices:One normalized parameter is added in the first matrix (40). As the iterative expressions (35) do not terminate in a limited period of time, one error criterion function can be applied to determine when to stop the entire iterative algorithm. This error criterion function may be thatWith this error criterion function as a judge to terminate the iterative algorithm, we summarize the basic steps of the interior point algorithm.

*Step 1. *Assume a pair of initial value is given as , and let .

*Step 2. *Calculate Lagrange multipliers and and define the parameters

*Step 3. *Verify whether the error criterion function holds: is a very small positive number; if above equality does not hold, then stop the iterative algorithm. Then the optimization variables at this time can be regarded as the optimal solution to a nonlinear optimization problem.

*Step 4. *Solve (40) and calculate the search direction .

*Step 5. *Use (36) to determine two steps and .

*Step 6. *Use the iterative expression (35) to solve the new iterative value.

*Step 7. *Let , .

*Step 8. *Return to Step 3.

In above steps, we make some modifications to compensate the drawback of the usual interior point algorithm. These modifications can guarantee the optimal solution of the original nonlinear optimization problem [15].

#### 5. Equivalence between the Two Optimization Problems

When solving the multiobjective optimization problem, firstly we apply the weighted sum strategy to convert it into one single objective optimization problem. Under the conditions of the positive weighted scalars (21), the equivalence between these two optimization problems holds. As there are elements in (19), rewrite equality (19) as follows:Similarly rewrite equality (20) as follows:Using (44) and (45), the conditions of equivalence between (44) and (45) can be summarized as the following proposition.

Proposition 1. *Let , and . If is an optimal solution of (45), then is an effective solution of (44).*

*Proof. *Let be an optimal solution of (45), and it satisfies . Applying the use of positive weights , we obtain the following equation:Choose a sufficiently large positive number such that the negative result about optimal solution holds. This positive number is chosen asNext we use the contradiction method to prove this proposition. Let be not an effective solution of (44), then there exists one and such thatFor all , we haveContinuing to formulate, we getMultiplying both sides of (50) by and taking sum operations, we haveIn (51), the last inequality contradicts the assumption that is an optimal solution of (45). So it means that is an effective solution of (44).

#### 6. Numerical Example

To verify the interior point algorithm in multi-UAVs formation autonomous reconfiguration, the formation includes three UAVs: one radar jamming UAV, one missile jamming UAV, and one investigation UAV. The initial positions of three UAVs are all located at starting point coordinates (0,0) and the terminate positions are concentrated on coordinates (700,700). The vector of the flight maximum speed, minimum speed, and the speed deviation is thatSurrounding battlefield environment contains radar threat, missile threat, and antiaircraft positions threat. The deployment coordinates of the radar threat are (300,300), and the deployment coordinates of the missile threat are (250,200). The region of the artillery positions threat is a rectangle range with a height of 300 and a width of 300. This rectangle range belongs to the no-fly zone.

Applying the interior point algorithm in multi-UAVs formation autonomous reconfiguration, the weighted factor for each UAV is The weighted matrix in the cost function is The discrete time sampling period is taken asThe length of time is , the number of UAVs is , and the initial value during the interior point algorithm is chosen as follows:Perturbation parameter is , a positive number is , the normalized parameter is , and the scalar is .

The simulation trajectory is shown in Figure 2. The coordinates of threat in surrounding battlefield environment are set as (296,346) and (229,173); the effect radius of the threat is 100 m. Assume the threat of the threat zero is infinite. In order to increase the flight performance, the density of sampling points in the vicinity of the threat can be higher than the area of no threat. In Figure 2, denotes the global optimal navigation point and denotes the position of the optimal navigation point. Two annular regions represent a range of threats.

From Figure 2, three UAVs formations experience a total of three formation autonomous reconfiguration processes. The first autonomous reconfiguration occurs in coordinates (200,100); the second occurs in coordinates (280,280). After these two formation autonomous reconfigurations, three UAVs can bypass these three threats and fly from initial position to terminate position.

Figure 3 shows the iterative convergence curves of cost functions with respect to three UAVs. Here each cost function is written as formula (20) with the weighted scalar value being . From Figure 3, with the interior point algorithm runs, after we substitute the optimal control input solution into the corresponding weighted sum cost function, the cost function will approach to zero closely with increasing number of iteration steps.

**(a) UAV1**

**(b) UAV2**

**(c) UAV3**

#### 7. Conclusion

After establishing one nonlinear multiobjective optimization problem in multi-UAVs formation autonomous reconfiguration, we use weighted sum strategy and combine all the equations or inequalities to derive a standard single objective nonlinear optimization problem. Furthermore the interior point algorithm is proposed to solve the optimization problem and some improvements are made to ensure the optimal solution of the original nonlinear optimization problem. But in this paper, the asymptotic property and sensitivity analysis are not studied, so these two are the next research subjects.

#### Competing Interests

The authors declare that there is no conflict of interests regarding the publication of this paper.

#### Acknowledgments

This work was supported by the Grants from the National Science Foundation of China (no. 31260273), the China-Montenegro Intergovernmental S&T Cooperation, and the JiangXI Provincial Foundation for Leaders of Disciplines in Science (20113BCB22008).

#### References

- A. Karimoddini, H. Lin, B. M. Chen, and T. H. Lee, “Hybrid three-dimensional formation control for unmanned helicopters,”
*Automatica*, vol. 49, no. 2, pp. 424–433, 2013. View at: Publisher Site | Google Scholar | MathSciNet - M. Innocenti, L. Pollini, and F. Giulietti, “Management of communication failures in formation flight,”
*Journal of Aerospace Computing, Information and Communication*, vol. 11, no. 1, pp. 19–35, 2004. View at: Google Scholar - H. Rezaee and F. Abdollahi, “Motion synchronization in unmanned aircrafts formation control with communication delays,”
*Communications in Nonlinear Science and Numerical Simulation*, vol. 18, no. 3, pp. 744–756, 2013. View at: Publisher Site | Google Scholar | MathSciNet - B. I. Triplett, D. J. Klein, and K. A. Morgansen, “Cooperative estimation for coordinated target tracking in a cluttered environment,”
*Mobile Networks and Applications*, vol. 14, no. 3, pp. 336–349, 2009. View at: Publisher Site | Google Scholar - S. Y. Li, Y. Zhang, and Q. Zhu, “Nash-optimization enhanced distributed model predictive control applied to the Shell benchmark problem,”
*Information Sciences*, vol. 170, no. 2–4, pp. 329–349, 2005. View at: Publisher Site | Google Scholar | MathSciNet - D. Schoerling, C. Van Kleeck, F. Fahimi, C. R. Koch, A. Ams, and P. Löber, “Experimental test of a robust formation controller for marine unmanned surface vessels,”
*Autonomous Robots*, vol. 28, no. 2, pp. 213–230, 2010. View at: Publisher Site | Google Scholar - H. Sun, R. Zhou, L. Zou, and Q. Ding, “Distributed cooperation target tracking for heterogeneous multi-UAV under communication and measurement constraints,”
*Acta Aeronautica et Astronautica Sinica*, vol. 32, no. 2, pp. 299–310, 2011. View at: Google Scholar - X.-Q. Zhang, “Research on improved leader following formation method,”
*Computer Engineering and Design*, vol. 31, no. 11, pp. 2547–2549, 2010. View at: Google Scholar - F. Giulietti, L. Pollini, and M. Innocenti, “Autonomous formation flight,”
*IEEE Control Systems Magazine*, vol. 20, no. 6, pp. 34–44, 2000. View at: Publisher Site | Google Scholar - R. C. Jian and R.-X. Wei, “Nash bargaining based self-reconfigurable UAV formation control method,”
*Automatica Sinica*, vol. 39, no. 8, pp. 1349–1359, 2013. View at: Google Scholar - R. C. Jian and R.-X. Wei, “UAV under communication delay conditions formation of independent security control reconstruction,”
*Control Theory & Applications*, vol. 30, no. 9, pp. 1099–1108, 2013. View at: Google Scholar - F. Giulietti, M. Innocenti, M. Napolitano, and L. Pollini, “Dynamic and control issues of formation flight,”
*Aerospace Science and Technology*, vol. 9, no. 1, pp. 65–71, 2005. View at: Publisher Site | Google Scholar | Zentralblatt MATH - Y. Ben-Asher, S. Feldman, P. Gurfil, and M. Feldman, “Distributed decision and control for cooperative UAVs Using Ad Hoc communication,”
*IEEE Transactions on Control Systems Technology*, vol. 16, no. 3, pp. 511–516, 2008. View at: Publisher Site | Google Scholar - W.-H. Chen, “Nonlinear disturbance observer-enhanced dynamic inversion control of missiles,”
*Journal of Guidance, Control, and Dynamics*, vol. 26, no. 1, pp. 161–166, 2003. View at: Publisher Site | Google Scholar - F. Giulietti, “Dynamics and control of different aircraft formation structures,”
*Aeronautical*, vol. 108, no. 10, pp. 117–124, 2004. View at: Publisher Site | Google Scholar

#### Copyright

Copyright © 2016 Wang Jian-hong and Rana Javed Masood. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.