Complex Formation Control of Large-Scale Intelligent Autonomous Vehicles
A new formation framework of large-scale intelligent autonomous vehicles is developed, which can realize complex formations while reducing data exchange. Using the proposed hierarchy formation method and the automatic dividing algorithm, vehicles are automatically divided into leaders and followers by exchanging information via wireless network at initial time. Then, leaders form formation geometric shape by global formation information and followers track their own virtual leaders to form line formation by local information. The formation control laws of leaders and followers are designed based on consensus algorithms. Moreover, collision-avoiding problems are considered and solved using artificial potential functions. Finally, a simulation example that consists of 25 vehicles shows the effectiveness of theory.
Distributed formation control of intelligent vehicles, including unmanned aerial vehicles, unmanned ground vehicles, and unmanned underwater submarines, has attracted a great attention, due to its broad applications, such as cooperative searching, surveillance, and combating using multiple unmanned air or ground vehicles. Roughly speaking, formation control strategy falls into six categories, namely, the behavior strategy [1–3], the potentials strategy [4–6], the virtual structure strategy [7–10], the distributed optimize strategy [11–14], and the consensus-based strategy [15–20].
The performances of the above strategies are almost excellent and effective when vehicles’ number is small. However, when the number is large and formation is complex, formation problems become complicated. In , a formation control framework is developed through dividing information into two independent parts. It can greatly reduce data exchange and realize various kinds of static formations. But, framework is developed based on a first-order model and the information dividing criterion is not given. Another approach in controlling a large group of vehicles is flocking control strategies [22–26]. The essence difference between formation control and flocking is that flocking is concentrated on achieving three heuristic rules introduced by Reynolds . The rules are cohesion, separation, and alignment in which formation requirements are not considered. In , a distributed flocking controller is proposed which only utilizes the neighbor information in both free and obstacle space. However, the flocking shape problems are studied in , a new piecewise smooth neighbor-based local controller is designed to regulate the flocking shape, three kinds of flocking shapes are obtained, such as, in a single line, vee shape or corner shape. Furthermore, flocking with formation within a constrained environment is studied in , a potential field-based method is proposed to achieve the specific formation, but each agent must know the relative positions of information. Also, the flocking shape problems are studied in the consensus framework  and in the Lie group setting .
Compared with the centralized formation, the communication and control structure of distributed formation is more flexible and is excluded from the restrictions of individual number. Consensus-based distributed formation control only needs local information acquired by wireless network and has received significant attention in the control community [28, 29]. Usually, intelligent vehicle acquires information through wireless network conveniently. However, communication time delays induced by network are inevitable. It is very important to study stability problems of time delay system. By using a small gain stability theorem and structured singular value in the frequency domain, a criterion to guarantee convergence is derived . A leader-following consensus problem of autonomous agents with coupling delays is studied and system stability conditions are obtained by using Lyapunov functions . Considering a finite set of bounded internal point and distributed delays, output-feedback stabilization is considered by linear dynamic controllers and an alternative stabilization technique on time delays in the controller is proposed in . A multiestimation-based adaptive controller is proposed in  to improve the transparency property of the teleoperation scheme. The closed-loop system’s stability is analyzed and stability capabilities of the overall scheme are carried out. With internal constant point delays,  researched the global asymptotic stability properties of switched systems under not very stringent conditions on the matrix functions of parameters. Several important and valued asymptotic stability conditions are obtained in this paper. In , by using algebraic graph theory, a method for decentralized stabilization of vehicle formations is proposed and a necessary and sufficient condition for an appropriate decentralized linear stabilizing feedback is obtained. In , the problems of packet dropouts, transmission delays, and quantization effects existing in the decentralized networked control systems are studied deeply. An efficient decentralized state feedback controller is designed and system stability conditions are acquired by using linear matrix inequalities.
When the number is large and formation is complex, it is impractical for each vehicle to obtain all the other vehicles’ state information quickly. Moreover, there are many uncertainties and disturbances in environment, which may lead to information transmission failure. In fact, it is worth paying more attention to some key members in a formation. One simple example is the line formation with loose space constraint between vehicles. It is necessary and very important to design appropriate formation frameworks.
In this paper, we propose a new hierarchy decentralized formation framework. Our purpose is to realize large-scale vehicles’ complex formations. In order to make the framework more close to reality, the second-order model and time delay are considered in formation control algorithm. The study is motivated by the work , the consensus-based formation control strategy [13–15], and the flocking shape problems [22–26]. The basic idea is given as follows.(1)Formation is described using vertexes and edges, and the number of leaders and followers is ascertained, respectively.(2)Automatically, based on initial position states and the formation information, vehicles are divided into two parts through wireless ad hoc network.(3)Leaders receive global information from control center by tel-network and form desired geometric shape based on consensus control strategy, meanwhile, broadcast their states through local wireless ad hoc network.(4)Followers receive leaders’ information and track their own virtual leaders using tracking consensus control strategy separately.(5)All vehicles adjust their states in a distributed manner.
The rest of the paper is organized as follows: in Section 2, some definitions are presented; in Section 3, formation control framework and control laws are discussed in detail; in Section 4, system stability conditions are obtained; in Section 5, numerical simulations are given to illustrate the effectiveness of the theoretical results; finally, concluding remarks are made in Section 6.
2. Problem Description and Preliminaries
Suppose the system under consideration consists of autonomous vehicles, labeled . All these vehicles share a common state space and interact with each other via wireless network. Moreover, each vehicle updates its current states based upon the information received from its neighbors. The dynamics of the vehicles are all the same and described by double integrators, the th vehicle has the dynamics as follows: where denote the position state, velocity state, and control vector separately.
We use graphs to describe complex formations. Thus, a formation can be constructed by a sequence of vertexes and lines. Vehicles in the vertex positions are called leaders and determine the basic frame of a formation. Vehicles in the line positions are called followers and associate with two leaders. Some examples of formations are given in Figure 1.
Definition 2.1. In dimension Euclidean space, each agent’s position vector is , , and relative position vector is , for all ; thus, a formation vector is defined as , where , is the projection of in each coordinate axis.
Definition 2.2. When , if for all holds, then formation is formed and maintained.
Definition 2.3. Potential function is a differentiable, nonnegative function of the distance between vehicles and if such that when and attains its unique minimum when vehicles and are located at a desired distance.
Definition 2.4. The Kronecker of two matrixes is defined as .
It is natural to model the interaction among vehicles using directed graph. Let be a graph of order , with a set of nodes , a set of edges , and an adjacency matrix , for all . If there is information exchange between node and , , else . In a directed graph, if , node is ’s out-degree neighbor, if , node is ’s in-degree neighbor. A set of node ’s out-degree neighbors is . A set of node ’s in-degree neighbors is ; similarly, a set of node ’s neighbors is . The degree matrix of graph is a diagonal matrix , , for all and is a Laplacian matrix of graph . Furthermore, we can obtain the normalized Laplacian matrix .
3. Main Results
3.1. Overview of Formation Framework
All vehicles equip the same wireless communication devices. That is they can interact with each other through local ad hoc wireless network and interact with control center through tel-network on demanding. It is necessary to design appropriate ad hoc network architecture and communication protocol to improve system’s performances. We adopt a cluster architecture ad hoc network and TDMA-type MAC protocol, where each vehicle is assigned to a specific time slot. We propose a distributed formation framework; see Figure 2.
Formation information is divided into global information and local information. Global information including number of leaders and followers, formation shape, velocity, and acceleration is transmitted by tel-network. Corresponding to global information, vehicle’s position and velocity are defined as local information transmitted via a local ad hoc network.
Once a formation is given, global formation information is ascertained by a control center. Follow on, the control center sends global formation information to a leader by a tel-network and obtained by the other leaders via local Ad hoc network. It is worth to note that global information can be set, changed, and injected to leaders at any time by the control center. However, there is one exception that initial information must be known by each vehicle. Then, using the dividing method, vehicles are automatically divided into two groups according to initial position information. Based on consensus algorithm and artificial potentials’ functions, leaders form a basic formation using global formation information set by the control center, and followers track their leaders to form the entire formation.
Assumption 3.1. Suppose that communication delays in the system are uniform and acquiring own state information has no delay, then, communication delay can be denoted by and .
3.2. Automatic Dividing Algorithm
When the number of vehicles is large and the formation is complex, it is very convenience to design an efficient dividing algorithm. Under the assumption that network is in the connectivity state at initial time, vehicles can elect leaders and followers automatically using the following algorithm.
Step 1. At the first time period, using flooding protocol, each vehicle acquires all the other’s initial position information and the global formation information.
Step 2. Each vehicle calculates the center of initial positions separately.
Step 3. Each vehicle calculates its distance to the center and composites the results in descending order (small node ID has higher prior) separately. The first vehicle in the descending sequence is defined as a leader, written as .
Step 4. Each vehicle calculates the angle made by the center, local agent, and :
Step 5. Each vehicle calculates , and composites the results in descending order (small node id has higher prior) separately. Tick out the vehicle and form a new sequence, then, the first vehicle in the descending sequence is defined as a leader, written as .
Step 7. Ascertain a followers’ leader. Compute the angle between leaders and followers in turn. According to the global formation information and the angle , followers associate with their two leaders which have max :
Step 8. Ascertain virtual leaders. The position and velocity of virtual leader is written as , and defined as follows:
where is a proportion factor correlative with expectation position.
A virtual leader can maintain that the virtual leader is at the expectation position of the line. The line is made by its leader each time.
3.3. Formation Control Laws
The design method of formation control laws are shown in Figure 3. Formation control law depends on the role of the vehicle if it is a leader, , otherwise, . Thus, the control law for an individual vehicle is designed as follows: where , , are leaders’ formation control law, followers’ formation control law, and collision avoidance control law separately.
The leaders’ formation control law is designed based on consensus algorithm. The control purpose is used to form desired formation shape and movement. Considering communication delay, control law is designed as follows: Because of that, Then, we can rewrite as follows: where is control vector; are the expected velocity and acceleration; is the communication weight, if information flows from to , , else ; , are control parameters; is desired relative distance vector and is number of current neighbors.
According to the individual control law (3.7), we can get the leader system’s control vector where Considering that, We can rewrite as follow: Note that system model (2.1) can be rewritten as follows: Consequently, substituting equation (3.11) into system model (3.12), we have Furthermore, we define Thus, the close loop of the leader system state equation is derived: where
The followers’ formation control law is designed based on the consensus algorithm also. The control purpose is tracking its virtual leader, respectively. Considering communication delay, control law is designed as follows:
The velocity feedback damp control term is used to regulate the vehicles’ velocity and is the damp control parameter. The consensus tracking control term is used to track its own virtual leader and is the consensus control parameter.
Let , , then we have
The followers’ formation control law is rewritten as follows:
Furthermore, we can acquire the formation control law of the follower system:
Consequently, the close loop of the follower system state equation is derived: where
The collision avoidance control law is designed based on artificial potential functions and the design methods are showed in Figure 4.
Consequently, the collision avoidance control law is designed as follows:
The control term is designed on artificial potential functions which are used to avoid collision, is artificial potential function, is the safe range, is communication range, and is positive control parameter.
4. Stability Analysis
In the following, we get two steps to study the system’s stability problems.
Lemma 4.1 (Schur complement). For a given symmetric matrix with the form , where , , , , if and only if and .
Step 1. The stability analysis of a leader system.
Theorem 4.2. Given communication delay , formation vector , velocity , acceleration , and control parameters , are bounded constants. Under the condition that directed network topology is connectivity, if there exit two symmetric matrixes , subject to , then for any time delay , the leader system is stable:
Proof. When the formation vector and desired velocity and acceleration , are known accurately and control parameters and are bounded constant, the bias vector is a bounded constant and plays no role in the system’s convergence. So, the leader system’s convergence (3.17) is the same as the following system:
By the Newton-Leibniz formula, we have
Define a Lyapunov-Krasovskii function for system (4.3) as follows:
Differentiating along the system (4.3), we can acquire
Sum the integral terms in , then, we have
According to (4.4) to (4.7), we have
According to (4.9), we get
Then we have . By Lemma 4.1, we get which is equivalent to :
If , then we have . Therefore, the leader system is stable and a basic formation is formed and maintained.
Step 2. The stability analysis of followers.
Theorem 4.3. Under the condition of Theorem 4.2, if a leader system is stable and there exit two symmetric matrixes subject to , then for any delay , a follower system is stable:
Proof. Similar to the proof of Theorem 4.2, we can derive the follower system’s stability condition. It is that if there exit two symmetric matrixes subject to , then for any delay , the follower system is stable.
According to the follower system’s close-loop state equation, the equilibrium point of the dynamic system is stable. If a leader system is stable, it means the condition , for all , is true. Consequently, we can easily acquire the equation . Thus, equations and are true which lead to . Furthermore, it is easy to see that and when . According to the virtual leader’s definition, local formation can be formed and maintained.
In this section we give a simulation example of multiple vehicles formation in the plane to illustrate the effectiveness of the proposed algorithm in the paper. In the simulations, 25 vehicles are randomly distributed in and ; initial velocities are randomly distributed in and . Expected velocity is and expected formation is shown as Figure 5. According to the proposed method, it is easily known that the number of leaders is 5 and the number of followers is 20. Leaders’ formation vector is :
Control parameters are , , , damp feedback coefficient , and velocity navigation coefficient . Communication range is 20 and safe range is 6. Time delay is 0.2 second. Simulation step is not fixed and total time is 60 seconds.
The initial positions of all vehicles are randomly distributed and the initial network is connectivity as shown in Figure 6(a). In the designed formation framework, vehicles can elect leaders and followers automatically using the dividing algorithm. The states of all vehicles after grouping are shown in Figure 6(b).
Formation movement of 25 vehicles can be seen clearly in Figure 7. At time 5 seconds, followers are tracking their own virtual leader shown in Figure 7(a). At time 10 seconds, followers have tracked their own virtual leaders shown in Figure 7(b). At time 15 seconds, leaders are forming desired formation geometric shape using the global formation information shown in Figure 7(c). Final states of all vehicles are shown in Figure 7(d); the desired formation is formed and maintained.
To show the simulation results clearly, we choose position and velocity on and axes to make the results fill in Figure 8. Trajectories of leader vehicles are shown in Figure 8(a); it shows that the desired formation is formed and maintained. Velocities of leader vehicles are shown in Figure 8(b); it shows that desired velocities are achieved. Trajectories of follower vehicles are shown in Figure 8(c), it shows that local formation is formed and maintained. Velocities of follower vehicles are shown in Figure 8(d); it shows that desired formation velocities are achieved.
In this paper, we proposed a distributed formation framework of large-scale intelligent autonomous vehicles. Under the assumption that the initial network is connected, the vehicles are divided into leaders and followers automatically. Global formation information is only injected to leaders which can greatly reduce data exchange. Using the designed formation control law, the vehicles are able to realize various kinds of formation asymptotically while avoiding collision. It is illustrated that the proposed formation framework is effective by simulation results.
Nevertheless, there are still some other problems that need to be discussed in further detai, such as introducing more complex dynamic model and considering obstacle avoidance problems.
The research is supported by the National Science Foundation of China (NSFC) under Grant 6001203.
T. Balch and R. C. Arkin, “Behavior-based formation control for multirobot teams,” IEEE Transactions on Robotics and Automation, vol. 14, no. 6, pp. 926–939, 1998.View at: Google Scholar
Y. Fan, L. Shirong, and D. Deguo, “Robot behavior and service-based motion behavior structure design in formation control,” Robot, vol. 34, no. 1, pp. 120–128, 2012.View at: Google Scholar
R. M. Kuppan Chetty, M. Singaperumal, and T. Nagarajan, “Behavior based multi robot formations with active obstacle avoidance based on switching control strategy,” Advanced Materials Research, vol. 433–440, pp. 6630–6635, 2012.View at: Google Scholar
N. E. Leonard and E. Fiorelli, “Virtual leaders, artificial potentials and coordinated control of groups,” in Proceedings of the 40th IEEE Conference on Decision and Control (CDC '01), pp. 2968–2973, December 2001.View at: Google Scholar
K. H. Kowdiki, R. K. Barai, and S. Bhattacharya, “Leader-follower formation control using artificial potential functions: a kinematic approach,” in Proceedings of the ICAESM, pp. 500–505, 2012.View at: Google Scholar
M. A. Lewis and K. H. Tan, “High precision formation control of mobile robots using virtual structures autonomous,” Autonomous Robots, vol. 4, no. 4, pp. 387–403, 1997.View at: Google Scholar
W. Ren and R. W. Beard, “Decentralized scheme for spacecraft formation flying via the virtual structure approach,” Journal of Guidance, Control, and Dynamics, vol. 27, no. 1, pp. 73–82, 2004.View at: Google Scholar
J. Hammer, G. Piper, O. Thorp, and J. Watkins, “Investigating virtual structure based control strategies for spacecraft formation maneuvers,” in Proceedings of the AIAA Guidance, Navigation, and Control Conference, pp. 925–930, August 2004.View at: Google Scholar
J. J. Arrieta-Camacho, L. T. Biegler, and D. Subramanian, “Trajectory control of multiple aircraft: an NMPC approach,” in Proceedings of the Assessment and Future Directions, vol. 358 of Lecture Notes in Control and Information Sciences, pp. 629–639, 2007.View at: Google Scholar
E.-K. Poh, J.-L. Wang, and K.-V. Ling, “Near optimal tracking solution for input constrained UAV using MPC,” in Proceedings of the AIAA Guidance, Navigation, and Control Conference, Toronto, Ontario, Canada, 2010.View at: Google Scholar
Z. Xiang-Yin and D. Hai-Bin, “Differential evolution-based receding horizon control design for multi-UVAs formation reconfiguration,” Transactions of the Institute of Measurement and Control, vol. 34, no. 2-3, pp. 165–183, 2012.View at: Google Scholar
C. W. Reynolds, “Hocks, herds, and schools: A distributed behavioral model,” Computer Graphics, vol. 21, no. 4, pp. 25–34, 1987.View at: Google Scholar
W. Ren, “Consensus based formation control strategies for multi-vehicle systems,” in Proceedings of the American Control Conference, pp. 4237–4242, June 2006.View at: Google Scholar
M. de la Sen, “On some structures of stabilizing control laws for linear and time-varying systems with bounded point delays and unmeasurable,” International Journal of Control, vol. 59, no. 2, pp. 529–541, 1994.View at: Google Scholar
A. Ibeas and M. de la Sen, “Robustly stable adaptive control of a tandem of master-slave robotic manipulators with force reflection by using a multiestimation scheme,” IEEE Transactions on Systems, Man, and Cybernetics, Part B, vol. 36, no. 5, pp. 1162–1179, 2006.View at: Publisher Site | Google Scholar
L. Bakule and M. Papík, “Decentralized control and communication,” Annual Reviews in Control, vol. 36, no. 1, pp. 1–10, 2012.View at: Google Scholar