Mathematical Problems in Engineering

Volume 2014, Article ID 874543, 6 pages

http://dx.doi.org/10.1155/2014/874543

## Formation Control of Multirobot Based on I/O Feedback Linearization and Potential Function

Key Laboratory of Advanced Control of Iron and Steel Process of Ministry of Education, School of Automation and Electrical Engineering, University of Science and Technology, Beijing 100083, China

Received 24 January 2014; Revised 30 March 2014; Accepted 3 May 2014; Published 14 May 2014

Academic Editor: Housheng Su

Copyright © 2014 Jie Dong et al. 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.

#### Abstract

Standard techniques of I/O linearization are widely applied to leader-follower approach for multirobot formation control. However general leader-follower approach cannot adapt to the environment with obstacles. Concerning that issue, a formation control method of multirobot system based on potential function is proposed in this paper, and a new control law is designed by choosing a proper potential function and employing Lyapunov stability theory, which stabilizes the formation of the multirobot system. We combine the method with a leader-follower approach to solve the problem that the latter cannot avoid obstacles. Simulation results are given to validate the method.

#### 1. Introduction

Multirobot formation control is a common cooperation problem of multirobot system. In recent years, as one of the basic coordination and cooperation issues, it has been gradually applied to military reconnaissance, search, demining, aircraft formation flying, space exploration, and many other fields and attracted a large number of researchers. It has become a very active research direction of multirobot system [1]. At present, formation control methods mainly include leader-follower approach [2–5], artificial potential field approach [6–9], behavior-based approach [10], and virtual structural approach [11]. To achieve a reasonable and efficient formation, the key is to use a proper control method that meets the system requirements. No matter what kind of control method is used, the stability of the system must be analyzed. Lyapunov stability theory [12–14] and graph theory [15, 16] are usually used in stability analysis, and these control theory researches contribute to the improvements of multirobot system. Lyapunov method plays a very important role in a multirobot system’s stability analysis and controller design. In [17], the idea of relative-position-based formation stability was proposed and the Lyapunov method was also used to design the decentralized controllers, along with an extended linear matrix inequality (LMI) to analyze the conditions required for formation stability. In [18], Lyapunov method was used to analyze the stability of multiagent coordination control. For each individual robot, there is a control Lyapunov function, and the Lyapunov function of the system is the weighted sum of all the agents’ Lyapunov functions. However, that paper presents a method based on Lyapunov stability theory, which gives a stable formation control law of the multirobot system by selecting an appropriate artificial potential field function. We combine this method with control based on input-output feedback linearization [19] to solve the problem that control cannot adapt to obstacles environment.

#### 2. Mathematical Model

In this section, the kinematics and dynamics of mobile robots are described in Figure 1. The robot consists of two driving rear wheels and a supporting roller, and the nonholonomic constraint that the driving wheels allow only pure rolling without slipping is satisfied. The kinematic and dynamic equations of motion of the th individual robot are given as where the position of the robot is given by . is the heading direction of the robot in the global coordinates. is the pose vector of robot . and are the linear and angular velocities at the center of the axle of each robot. is control input (acceleration).

#### 3. Control of Formations

##### 3.1. Control Based on Input-Output Feedback Linearization

control is a kind of leader-follower approach. A group of two nonholonomic mobile robots is shown in Figure 2. The aim of the controller is to make the follower (Robot2) follow the leader (Robot1) by keeping the relative distance and the relative orientation constant. As a result, both the values can be controlled to reach the desired value and maintain the desired formation.

We introduce ; according to the geometrical relationship, the differential equation of and is given by where and are the linear and angular velocities at the center of the axle of each robot. The distance between the supporting roller and the center of the axis of the driving wheels of each robot is denoted by . In order to avoid collisions between robots, we will require that .

We use standard techniques of I/O linearization to generate a control law [12], which is given by where That leads to dynamics in the variables of the form where and are constants. By selecting appropriate values, the relative distance and angle between the robots can converge to , and the system becomes stable.

##### 3.2. Control Based on Artificial Potential Field Function

An artificial potential field approach is a virtual force method proposed by Khatib. Its basic idea is that the robots move in a virtual force field. Obstacles are surrounded by repulsive potential field, which produces a repulsive force that decreases rapidly with the closer distance between the robot and the obstacle. The target is surrounded by attractive potential field, which produces an attractive force that decreases as the robot is close to the target. Under the role of the resultant force, the robots move along the direction of minimizing potential energy. For multirobot formation control, we need to design a suitable potential function to maintain the formation while reaching the target and avoiding obstacles. Potential function is defined as follows.

*Definition 1 (potential function). *Potential function is a differentiable, nonnegative, and unbounded function of the distance between robot and , and the following conditions are satisfied.(1)When , .(2)When the distance achieves the desired distance, that is, , gets the only minimum value.The potential function of neighbor robot and is chosen as follows:
where , is a positive constant, and then the force is the negative gradient of the potential energy:
where , are the position vectors of robots and .

The potential energy and force described by (6) and (7) are shown in Figure 3. It indicates that when , that is, , , the robots are attractive, when , that is, , , the robots are repulsive, and when , that is, , , the force between the robots achieves balance, and is minimized.

#### 4. Control Based on I/O Feedback Linearization and Potential Function

##### 4.1. Design of a Stable Formation Control Law

Considering a system of n robots, the dynamic of each robot is described by (1). The total potential energy and force acting on robot contributed from all the other robots are given as When the formation moves toward the target in an environment with obstacles, also includes the attractive force of the target and the repulsive force of the obstacles. The magnitude of projected in the heading direction of the robot is used to control the translational acceleration of the robot. The angle is used as the desired orientation for the heading direction of the robot. Let be the direction of the resultant force of robot , and the orientation error can be described as

Theorem 2. *For a multirobot system described by (1), the potential force shown by (9) acts on each robot, and the angle of the resultant force is defined as the desired orientation of them. Then, the following control law stabilizes the formation of the system:
**
where , , are positive constants and , are the components of in the and directions, respectively.*

*Proof. *(1) . Consider the following Lyapunov candidate:
The time derivative of is computed as
Insert (11) into (13):
where , due to , so .

(2) . Consider the following Lyapunov candidate:
Insert (11) into (15), and then calculate the derivative of :

From (10),

Let , and then , that is, , so .

Consequently, the stability of the formation is proved with Lyapunov stability theory.

##### 4.2. Combination Control Method

control based on I/O feedback linearization is simple, that we just control the follower robot to follow the trajectory of the leader robot. In this way, the formation control can be simplified to an independent tracking problem. Each robot only needs to obtain the status information of its leader, which greatly simplifies the issue of cooperation among robots. However, this feedback control cannot avoid obstacles, while the artificial potential field approach is effective in obstacle avoidance. For this reason, if we combine those two methods, the problem will be solved.

The strategy is as follows. The leader adopts the artificial potential field approach for path planning to reach the target while avoiding obstacles. The follower uses I/O feedback linearization combination with potential function to maintain formation in the obstacles environment; that is, when the follower is in the region influenced by obstacles, the combination method is applied, and the control performance can be improved by adjusting the weight, and then when out of the influenced region, control based on I/O feedback linearization is only used. The algorithm flow chart is shown in Figure 4.

#### 5. Simulation

In this section, computer simulation is used to verify the previous conclusions. For a group of 3 robots, the robots maintain triangular formation to reach the target while avoiding obstacles, which were idealized as circular objects just as described in [20].

*(1) Formation Control Based on Potential Function.* The initial positions of the robots are , , and . The position of the target is . The obstacle is a circle of radius 1 centered at . Under the role of the potential energy described by (6) and applying the control law (11), the robots form an equilateral triangle formation with the side length of 3, avoid the obstacle, keep the same speed and direction, and reach the target at last just as shown in Figure 5. Figure 6 illustrates the change of errors . It is observed that the formation is stable.

*(2) Control Based on ** and Potential Function.* The initial positions of the robots are , , and . The position of the target is . The obstacle is a circle of radius 1 centered at . Robot1 is the leader, and Robot2, Robot3 are the followers keeping a distance of 2, angles of , , respectively, from Robot1. When the formation enters into the influenced region of the obstacle, use the approach of control based on and potential function. Otherwise, control based on I/O feedback linearization is applied. Figure 7 illustrates that single control cannot avoid obstacles, while by using the proposed combination control method, the formation can successfully round the obstacle and move to the target keeping a stable formation, as shown in Figure 8.

#### 6. Conclusions

Formation control of multirobot system was studied in the paper. A new artificial potential field function and corresponding formation controller were designed, and the stability analysis was given. In addition, we proposed a combination control method based on I/O feedback linearization and potential function, of which feature is choosing the appropriate control strategy according to obstacles environment, solving the problem that control cannot avoid obstacles.

#### Conflict of Interests

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

#### Acknowledgments

This work was supported by the Natural Science Foundation of China (NSFC) under Grant no. 61074085 and by Beijing Natural Science Foundation (4142035), China.

#### References

- L. Lei,
*Formation and Coordination Control of Multiple Mobile Robots*, Huazhong University of Science and Technology, Wuhan, China, 2009. - X. Chen, A. Serrani, and H. Ozbay, “Control of leader-follower formations of terrestrial UAVs,” in
*Proceedings of the 42nd IEEE Conference on Decision and Control*, vol. 1, pp. 498–503, December 2003. View at Publisher · View at Google Scholar - K. H. Kowdiki, R. K. Barai, and S. Bhattacharya, “Leader-follower formation control using artificial potential function: a kinematic approach,” in
*Proceeding of the IEEE-International Conference on Advances in Engineering, Science and Management*, pp. 500–505, Tamil Nadu, India, March 2012. - H. Su, X. Wang, and Z. Lin, “Flocking of multi-agents with a virtual leader,”
*IEEE Transactions on Automatic Control*, vol. 54, no. 2, pp. 293–307, 2009. View at Publisher · View at Google Scholar · View at Scopus - H. Su, X. Wang, and G. Chen, “A connectivity-preserving flocking algorithm for multi-agent systems based only on position measurements,”
*International Journal of Control*, vol. 82, no. 7, pp. 1334–1343, 2009. View at Publisher · View at Google Scholar · View at Zentralblatt MATH · View at Scopus - O. Khatib, “Real-time obstacle avoidance for manipulators and mobile robots,”
*The International Journal of Robotics Research*, vol. 5, no. 1, pp. 90–98, 1986. View at Google Scholar · View at Scopus - J. Sfeir, M. Saad, and H. Saliah-Hassane, “An improved artificial potential field approach to real-time mobile robot path planning in an unknown environment,” in
*Proceeding of the 9th IEEE International Symposium on Robotic and Sensors Environments*, pp. 208–213, Montreal, Canada, September 2011. View at Publisher · View at Google Scholar · View at Scopus - R. Olfati-Saber and R. M. Murray, “Distributed cooperative control of multiple vehicle formations using structural potential functions,” in
*Proceeding of the IFAC World Congress*, pp. 346–352, 2002. - R. Olfati-Saber, “Flocking with obstacle avoidance,” Tech. Rep. CIT-CDS03-006, California Institute of Technology, Control and Dynamical Systems, Pasadena, Calif, USA, 2003. View at Google Scholar
- 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 Publisher · View at Google Scholar · View at Scopus - 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 Publisher · View at Google Scholar · View at Scopus - H. Su, N. Zhang, M. Z. Q. Chen, H. Wang, and X. Wang, “Adaptive flocking with a virtual leader of multiple agents governed by locally Lipschitz nonlinearity,”
*Nonlinear Analysis: Real World Applications*, vol. 14, no. 1, pp. 798–806, 2013. View at Publisher · View at Google Scholar · View at Zentralblatt MATH - A. Yang, W. Naeem, G. W. Irwin, and K. Li, “Stability analysis and implementation of a decentralized formation control strategy for unmanned vehicles technology,”
*IEEE Transactions on Control Systems Technology*, vol. 22, no. 2, pp. 706–720, 2014. View at Publisher · View at Google Scholar - X. Luo, N. Han, and X. Guan, “Leader-following consensus protocols for formation control of multi-agent network,”
*Journal of Systems Engineering and Electronics*, vol. 22, no. 6, pp. 991–997, 2011. View at Publisher · View at Google Scholar · View at Scopus - J. A. Fax and R. M. Murray, “Information flow and cooperative control of vehicle formations,”
*IEEE Transactions on Automatic Control*, vol. 49, no. 9, pp. 1465–1476, 2004. View at Publisher · View at Google Scholar · View at Scopus - M. M. Zavlanos, M. B. Egerstedt, and G. J. Pappas, “Graph-theoretic connectivity control of mobile robot networks,”
*Proceedings of the IEEE*, vol. 99, no. 9, pp. 1525–1540, 2011. View at Publisher · View at Google Scholar · View at Scopus - D. Xue, J. Yao, G. Chen, and Y. L. Yu, “Formation control of networked multi-agent systems,”
*IET Control Theory and Applications*, vol. 4, no. 10, pp. 2168–2176, 2010. View at Publisher · View at Google Scholar · View at Scopus - P. Ogren, M. Egerstedt, and X. Hu, “A control Lyapunov function approach to multiagent coordination,”
*IEEE Transactions on Robotics and Automation*, vol. 18, no. 5, pp. 847–851, 2002. View at Publisher · View at Google Scholar · View at Scopus - J. P. Desai, J. Ostrowski, and V. Kumar, “Controlling formations of multiple mobile robots,” in
*Proceedings of the IEEE International Conference on Robotics and Automation*, vol. 4, pp. 2864–2869, Leuven, Belgium, May 1998. View at Publisher · View at Google Scholar · View at Scopus - Y. Liang and H. Lee, “Decentralized formation control and obstacle avoidance for multiple robots with nonholonomic constraints,” in
*Proceedings of the American Control Conference*, pp. 5596–5601, Minneapolis, Minn, USA, June 2006. View at Publisher · View at Google Scholar · View at Scopus