About this Journal Submit a Manuscript Table of Contents
Journal of Control Science and Engineering
Volume 2012 (2012), Article ID 150250, 12 pages
http://dx.doi.org/10.1155/2012/150250
Research Article

Consensus Formation Control for a Class of Networked Multiple Mobile Robot Systems

Department of Mechanical Engineering, Dalhousie University, Halifax, NS, Canada B3J 2X4

Received 17 November 2011; Accepted 1 March 2012

Academic Editor: Peter X. Liu

Copyright © 2012 Long Sheng 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

A consensus-based formation control for a class of networked multiple mobile robots is investigated with a virtual leader approach. A novel distributed control algorithm is designed based on the Lyapunov method and linear matrix inequality (LMI) technique for time delay systems. A multiple Lyapunov Krasovskii functional candidate is proposed for investigating the sufficient conditions to linear control gain design for the system with constant time delays. Simulation results as well as experimental studies on Pioneer 3 series mobile robots are shown to verify the effectiveness of the proposed approach.

1. Introduction

Embedded computational resources in autonomous robotic vehicles are becoming more abundant and have enabled improved operational effectiveness of cooperative robotic systems in civilian and military applications. Compared to autonomous robotic vehicles that operate single tasks, cooperative teamwork has greater efficiency and operational capability. Multirobotic vehicle systems have many potential applications, such as platooning of vehicles in urban transportation, the operation of the multiple robots, autonomous underwater vehicles, and formation of aircrafts in military affairs [13].

The study of group behaviors for multirobot systems is the main objective of the work. Group cooperative behavior signifies that individuals in the group share a common objective and action according to the interest of the whole group. Group cooperation can be efficient if individuals in the group coordinate their actions well. Each individual can coordinate with other individuals in the group to facilitate group cooperative behavior in two ways, named local coordination and global coordination. For the local coordination, individuals react only to other individuals that are close, such as fish engaged in a school. For the global coordination, each individual can directly coordinate its act with every other individual in the group. Due to communication constraints, most researchers are interested primarily in group cooperation problems where the coordination occurs locally [46].

Cooperative control of multirobotic vehicle systems brings us significant theoretical [79] and practical challenges. For example, the research objective is defined based on a system of some subsystems rather than a single system; the effects caused by the communication constraints should be considered and how to design coordination strategies so that coordination will result in a group cooperation [10, 11].

As a concrete example of cooperative control, the formation control of multiple autonomous vehicles receives significant interest in recent years [1215]. It requires that autonomous robotic vehicles collectively maintain a prescribed geometric shape during movement. Maintaining an accurate geometric configuration among multiple robotic vehicles moving in formation can result in less expensive and more capable systems that can accomplish objectives impossible for a single vehicle. The advantages of the formation control for multirobotic systems can be summarized as follows: good feasibility, accuracy, robustness, flexibility, lower cost, energy efficiency, and probability of success. For example, a group robotic vehicles can be used for large objective transferring, terrain model reconnaissance, unknown area exploration, and path obstruction.

Various strategies and approaches, which can be roughly categorized as leader-follower, behavioral, and virtual leader approaches [16], have been proposed for the formation control. In the leader-follower approach, one of the vehicles is appointed as the leader, and other vehicles in the group are appointed as the followers. When the group cooperative behavior occurs, the followers should track the trajectory of the leader with some prescribed offset. The basic idea about the behavioral approach is to prescribe several desired behaviors for each vehicle and to make the control action to each vehicle according to each behavior. In the virtual leader structure approach, the entire formation of the group is treated as a single structure. The virtual leader’s dynamic or trajectory is converted as the desired action of each vehicle in the group. Tracking control based on consensus algorithm is then needed to tackle this problem.

In the proposed work, a novel distributed control algorithm is designed based on the Lyapunov method and linear matrix inequalities (LMIs) technique for multiple robot systems. Note that Lyapunov-based approaches and LMIs technique have been successfully and widely applied in the area of systems and control. For example, in [17], a survey is in analysing the stability of time-delay systems by using of a Lyapunov-based method, LKF (Lyapunov Krasovskii function) theory to derive sufficient stability conditions in the form of LMIs. Furthermore, in [18], a set-value Lyapunov approach is to prove the stability of multiagent systems under a condition of time-dependent communication links. A Lyapunov-based stability theory and LMIs-based control method are described comprehensively in [19, 20], respectively.

In this work, a consensus-based design scheme is applied to the formation control of multiple-wheeled mobile-robot group with a virtual leader. The group communication configuration is assumed to be a fully coupled system which means decisions made by each robot in the group affect the cost and outcomes of all other members of the group. In this case, what a single robot is going to do is affected by what all other robots in the group are going to do. The distributed formation control architecture is defined to accommodate an arbitrary number of subgroup leaders and arbitrary information flow among the robots. This architecture requires neighbor-to-neighbor information exchange. At the group level, the consensus tracking algorithm is applied to guarantee consensus on the time-varying group reference trajectory in a distributed manner. A consensus-based formation control strategy developed based on the group level consensus tracking algorithm is applied for vehicle level control.

A novel delay-dependent multiple Lyapunov functional candidate related to LKF is constructed to investigate the convergence of the tracking error. The null sums have been added to the new multiple LKF with free weighting matrices introduced to reduce the conservatism in the derivation of the stability conditions. Therefore, the matrices and the sufficient conditions for the stabilization of the proposed control approach can be determined by solving LMIs. The effects caused by the group communication delays are well considered in the proposed approach. In addition to simulation results, the proposed control strategy is experimentally implemented for multiple-wheeled mobile robots under neighbor-to-neighbor information exchange with group communication delay involved.

Notations
The information exchange among robots is usually modelled by graphs. Suppose that a team consists of 𝑛 mobile robots. ç𝑛=(𝜈𝑛,𝜀𝑛) is a graph, where 𝜈𝑛=1,,𝑛 is a finite nonempty node set, and 𝜀𝑛𝜈𝑛×𝜈𝑛 is an edge set of ordered pairs of nodes, called edges. The adjacency matrix 𝐴𝑛=[𝑎𝑖𝑗]𝑅𝑛×𝑛 of a graph ç𝑛=(𝜈𝑛,𝜀𝑛) is defined such that 𝑎𝑖𝑗 is a positive weight if (𝑗,𝑖)𝜀𝑛 is ture, and 𝑎𝑖𝑗=0 if (𝑗,𝑖)𝜀𝑛 is false.

2. Modelling of Pioneer 3 Mobile Robots

Pioneer mobile robots are durable, differential-drive robots for academic researchers. The most famous advantages of Pioneer 3 robot series are good versatility, reliability, and durability. In this work, two kinds in the series named Pioneer 3-DX (P3-DX) and Pioneer 3-AT (P3-AT) have been used for the experimental implementation.

The P3-DX used in our lab is shown in Figure 1(a). It assembled motors with 500-tick encoders, 19 cm wheels, 8 forward-facing ultrasonic sensors, 8 real-facing sonar, 1, 2, or 3 rechargeable batteries, and a microcontroller which can communicate with a laptop through serial port. P3-DX can reach the maximum speed of 1.6 meters per second and carry a payload of up to 23kg. It is an all-purpose base and can be used for research and applications involving mapping, teleoperation, localization, monitoring, reconnaissance, vision capture, cooperation, and other behaviors. P3-DX runs best on hard surfaces. It can traverse low sills and household power cords, and it can also climb most wheelchair ramps.

fig1
Figure 1: Pioneer 3-DX and 3-AT mobile robots.

Another robot P3-AT used in this work is shown in Figure 1(b). It is a highly versatile four-wheel drive robotic platform, which is softwarecompatible with other pioneer 3 robots. P3-AT is a popular team performer for outdoor or rough-terrain projects. It has powerful motors and four knobby wheels that can reach the maximum speed of 0.8 meters per second and carry a payload of up to 12kg. P3-AT uses 100-tick encoders with inertial correction recommended for dead reckoning to compensate for skid steering. Similar with P3-DX, P3-AT also has 8 forward and 8 rear sonar, a microcontroller which can be connected with a laptop through serial port and batteries.

Both of P3-DX and P3-AT have the same kinematic model which can be expressed by the following equation:̇̇𝑥=𝜐cos(𝜃),̇𝑦=𝜐cos𝜃,𝜃=𝜔,(1) where [𝑥,𝑦] is the inertial position of the P3 mobile robot, 𝜃 is the orientation of the robot, and [𝜐,𝜔] denote the linear and angular speeds of the robot. Since the P3 mobile robots used in this work have nonholonomic constraints, the coordination problem becomes more complicated. As we know, nonholonomic systems cannot be stabilized with continuous static-state feedback, so the difficulty of the coordination problem for differentially driven mobile robots is that the position and orientation of the center of the robot cannot be simultaneously stabilized with a time-invariant feedback control strategy. Some researchers successfully used discontinuous control laws and time-varying control laws to stabilize the center of a single differentially driven mobile robot; however, the multiple robot case is more complicated for sure.

The most popular way to simplify this complex case is to define a hand position for each robot. As shown in Figure 2, the hand position of the robot usually has been defined at the point =[𝑥,𝑦]𝑇 which lies a distance 𝐿 along the line that is normal to the wheel axis and intersects the wheel axis at the center point 𝑟=[𝑥,𝑦]𝑇. The kinematic model of the hand position is holonomic for 𝐿0. Instead of considering the coordinating problem at the center of the robot, we consider the problem at the hand position. Another important advantage of defining a hand position for the robot is that the hand position has practical interest. For example, if the task of the robot group is to move an object from one place to another by using the gripper which has been installed at the hand position of each robot, then the control objective for this task is to move the gripper locations in a coordinated fashion.

150250.fig.002
Figure 2: Hand position for P3 mobile robot.

Now, let us find the kinematic model for the hand position of each robot. First, the hand position can be represented by the following equation: 𝑥=𝑥+𝐿cos(𝜃),𝑦=𝑦+𝐿sin(𝜃),(2) where 𝐡=[𝑥,𝑦]𝑇 is the hand position in 𝑥 and 𝑦 plane. Now, let us differentiate (2) with respect to time and substitute (1), then we get ̇𝑥̇=cos(𝜃)𝜐𝐿sin(𝜃)𝜔,𝑦=sin(𝜃)𝜐+𝐿cos(𝜃)𝜔.(3)

Define 𝐡=[𝑥,𝑦]𝑇, 𝐮=[𝑢𝑥,𝑢𝑦]𝑇 and let 𝜐=cos(𝜃)𝑢𝑥+sin(𝜃)𝑢𝑦,1𝜔=𝐿sin(𝜃)𝑢𝑥+1𝐿cos(𝜃)𝑢𝑦,(4) then we have ̇𝐡=𝐮,(5) which is the kinematic model of the robot’s hand position.

3. Problem Formulation

As described in the above section, the nonlinear kinematic model of the center position of the robot has been simplified and linearized into the form of single-integrator dynamics shown in (5) by defining a hand position for each robot. The control interest has been converted from the center position of the robot to its hand position. So the state of the hand position of the robot is used as the state of the robot itself.

The virtual leader and virtual structure approach is one solution to formation control. Figure 3 shows the example of the virtual leader and virtual structure approach with a formation composed of three vehicles with planar motions. In Figure 3, 𝐶0 is the global coordinate system, 𝑟𝑖(𝑡)=[𝑥𝑖(𝑡),𝑦𝑖(𝑡)]𝑇 is the 𝑖th vehicle’s actual position at time 𝑡, and 𝑟𝑑𝑖(𝑡)=[𝑥𝑑𝑖(𝑡),𝑦𝑑𝑖(𝑡)]𝑇 is the 𝑖th P3 mobile robot’s desired positions at time 𝑡. Both its actual and desired position at time 𝑡 are relative to 𝐶0. The group can move with the desired formation shape only if each vehicle can track its desired position accurately.

150250.fig.003
Figure 3: The framework for P3 mobile robot team with virtual leaders.

In this paper, we assumed each P3 mobile robot knows the state of its virtual subgroup leader versus time. If each vehicle has inconsistent knowledge of its virtual subgroup leader’s states, then the desired formation cannot be maintained.

The linearized model of each robot in the group can be represented by the following equation: ̇𝐫𝑖(𝑡)=𝐮𝑖(𝑡),𝑖=1,,𝑛,(6) where 𝐫𝑖(𝑡)=[𝑥𝑖(𝑡),𝑦𝑖(𝑡)]𝑇𝑅𝑛 is the state of the 𝑖th robot in the group which includes its position and velocity information. 𝑖 is the index denoting the number of the robot in the group. 𝑛 is the total number of all robots in the group. 𝐮𝑖(𝑡)𝑅𝑚 is the control input signal.

Now, define the virtual subgroup leader’s state, which is also the desired state for each P3 mobile robot in the group, as 𝐫𝑑𝑖(𝑡)=[𝑥𝑑𝑖(𝑡),𝑦𝑑𝑖(𝑡)]𝑇. If 𝐫𝑖(𝑡)𝐫𝑑𝑖(𝑡), 𝑖=1,,𝑛, as 𝑡, then the desired formation shape is maintained, and the group movement follows the desired reference.

4. A Novel Consensus Control Approach

In [21], the controller 𝐮𝑖 is designed for agents in the form of integrators such that all followers track the virtual leader with local interaction in the absence of velocity measurements. Specifically, a distributed consensus tracking algorithm is defined as 𝐮𝑖(𝑡)=𝛼𝑛𝑗=0𝐚𝑖𝑗𝐫𝑗𝐫𝑖𝛽sgn𝑛𝑗=0𝐚𝑖𝑗𝐫𝑖𝐫𝑗,(7) where 𝛼 is a nonnegative constant, 𝛽 is a positive constant, and sgn() is the signum function, since it considers the tracking problem under fixed and switching network topologies. In the proposed work, a new distributed consensus tracking control algorithm with consideration of some communication delay can be represented as𝐮𝑖̇𝐫(𝑡)=𝑑𝑖(𝑡)𝐤𝑖𝐫𝑖(𝑡)𝐫𝑑𝑖(𝑡)𝑛𝑗=1,𝑖𝑗𝐚𝑖𝑗𝐫𝑗(𝑡𝜏)𝐫𝑑𝑗,(𝑡𝜏)(8) where 𝐤𝑖 is the designed control gain. Notice that each robotic vehicle in the group has the same group communication coupling and kinematic model, 𝐤𝑖 can be represented as 𝐤 instead, 𝐚𝑖𝑗 is the (𝑖,𝑗) entry of adjacency matrix 𝐴𝑛𝑅𝑛×𝑛 according to the interaction topology Ç𝑛=(𝜈𝑛,𝜀𝑛) for 𝐫𝑖𝐫𝑑𝑖, 𝐫𝑗𝐫𝑑𝑗 is the information from neighbors of the 𝑖th P3 mobile robot, which can also be treated as the coupling between the 𝑖th P3 mobile robot and its neighbors, and 𝜏 is the constant network-induced group communication delay. Submiting (8) into (6), we havė𝐫𝑖̇𝐫(𝑡)=𝑑𝑖𝐫(𝑡)𝐤𝑖(𝑡)𝐫𝑑𝑖(𝑡)𝑛𝑗=1,𝑖𝑗𝐚𝑖𝑗𝐫𝑗(𝑡𝜏)𝐫𝑑𝑗.(𝑡𝜏)(9) If we define 𝐞𝑖(𝑡)=𝐫𝑖(𝑡)𝐫𝑑𝑖(𝑡),(10) then (9) can be rewritten as ̇𝐞𝑖(𝑡)=𝐤𝐞𝑖(𝑡)𝑛𝑗=1,𝑖𝑗𝐚𝑖𝑗𝐞𝑗(𝑡𝜏).(11) It is obvious that if 𝐞𝑖0,𝑖=1,,𝑛 as 𝑡 which means 𝐫𝑖𝐫𝑑𝑖,𝑖=1,,𝑛 as 𝑡, then the desired formation shape is maintained, and the group movement follows the desired reference. The next step is to find the sufficient conditions for the design of the control gain 𝐤 so that it can stabilize the error dynamics represented by (11).

Lemma 1 (Jensen inequality). For any constant matrix 𝐸𝑛×𝑛, 𝐸=𝐸𝑇>0, vector function 𝝎[0,𝜏]𝑛 such that the integrations concerned are well defined, then

𝜏𝜏0𝝎𝑇(𝑠)𝐸𝝎(𝑠)𝑑𝑠𝜏0𝝎(𝑠)𝑑𝑠𝑇𝐸𝜏0𝝎(𝑠)𝑑𝑠.(12)

Theorem 2. Consider the error dynamics model represented by (11), for a given time delay 𝜏 and the number of members in one group 𝑛; if there exist symmetric positive definite matrices 𝑃=𝑃11𝑃12𝑃𝑇12𝑃22>0, 𝑄=𝑄1100𝑄22>0, 𝑅=𝑅1100𝑅22>0, matrices 𝑀𝑖,𝑁𝑖,𝑖=1,,5 with appropriate dimensions, such that the following inequality holds: 𝐻𝐻=11𝐻21𝐻22𝐻31𝐻32𝐻33𝐻41𝐻42𝐻43𝐻44𝐻51𝐻52𝐻53𝐻54𝐻55<0,(13) where 𝐻11=𝑃12+𝑃𝑇12𝑄+(𝑛1)11𝑅+(𝑛1)𝜏11+𝑁1+𝑁𝑇1+𝑀1𝐾+𝐾𝑇𝑀𝑇1,𝐻21𝑃=𝑇12+𝑁2𝑁𝑇1+𝐴𝑇𝑀𝑇1+𝑀2𝐻𝐾,22𝑄=(𝑛1)11𝑁2𝑁𝑇2+𝑀2𝐴+𝐴𝑇𝑀𝑇2,𝐻31𝑃=(𝑛1)11+𝑁3+𝑀𝑇1+𝑀3𝐻𝐾,32=𝑁3+𝑀3𝐴+𝑀𝑇2,𝐻33𝑄=(𝑛1)22𝑅+(𝑛1)𝜏22+𝑀3+𝑀𝑇3,𝐻41𝑃=(𝑛1)22+𝑁4+𝑀4𝐻𝐾,42𝑃=(𝑛1)22𝑁4+𝑀4𝐻𝐴,43=𝑃𝑇12+𝑀4,𝐻52=𝑁𝑇2𝑁5+𝑀5𝐻𝐴,51=𝑁𝑇1+𝑁5+𝑀5𝐻𝐾,44𝑅=(𝑛1)11𝜏,𝐻53=𝑁𝑇3+𝑀5,𝐻54=𝑁𝑇4,𝐻55𝑅=(𝑛1)22𝜏𝑁5𝑁𝑇5,(14) then system (11) is asymptotically stable, for example, 𝐞𝑖(𝑡) tends to zero asymptotically which means the 𝑖𝑡 robot in the group tracks its desired trajectory well.

Proof. For each robot in the group, we take the Lyapunov Krasovskii functional candidate as 𝑉𝑖=(𝑛1)𝐞𝑇𝑖(𝑡)𝑃11𝐞𝑖(𝑡)+2𝐞𝑇𝑖(𝑡)𝑃𝑛12𝑗=1,𝑗𝑖𝑡𝑡𝜏𝐞𝑗+(𝑠)𝑑𝑠𝑛𝑗=1,𝑗𝑖𝑡𝑡𝜏𝐞𝑇𝑗(𝑠)𝑑𝑠𝑃22𝑡𝑡𝜏𝐞𝑗+(𝑠)𝑑𝑠𝑛𝑗=1,𝑗𝑖𝑡𝑡𝜏𝐞𝑇𝑗̇𝐞(𝑠),𝑇𝑗𝑄𝐞(𝑠)𝑗̇𝐞(𝑠)𝑗+(𝑠)𝑑𝑠𝑛𝑗=1,𝑗𝑖0𝜏𝑡𝑡+𝜃𝐞𝑇𝑗̇𝐞(𝑠),𝑇𝑗𝑅𝐞(𝑠)𝑗̇𝐞(𝑠)𝑗(𝑠)𝑑𝑠𝑑𝜃,(15) and now we define ̂𝐞𝑇𝐞(𝑡)=𝑇1(𝑡),,𝐞𝑇𝑛(𝑡)1×𝑛,(16) and take the multiple Lyapunov Krasovskii functional candidate as 𝑉=𝑛𝑖=1𝑉𝑖̂𝐞=(𝑛1)𝑇𝑃(𝑡)11̂̂𝐞𝐞(𝑡)+2𝑇𝑃(𝑡)12𝑡𝑡𝜏̂𝐞(𝑠)𝑑𝑠+(𝑛1)𝑡𝑡𝜏̂𝐞𝑇𝑃(𝑠)𝑑𝑠22𝑡𝑡𝜏̂𝐞(𝑠)𝑑𝑠+(𝑛1)𝑡𝑡𝜏̂𝐞𝑇̇̂𝐞(𝑠),𝑇𝑄(𝑠)1100𝑄222𝑛×2𝑛̂𝐞̇̂(𝑠)𝐞(𝑠)𝑑𝑠+(𝑛1)0𝜏𝑡𝑡+𝜃̂𝐞𝑇̇̂𝐞(𝑠),𝑇𝑅(𝑠)1100𝑅222𝑛×2𝑛×̂𝐞̇̂(𝑠)𝐞(𝑠)𝑑𝑠𝑑𝜃,(17) where 𝑃𝑖𝑖𝑃=diag𝑖𝑖,,𝑃𝑖𝑖𝑛×𝑛𝑃,𝑖=1,2,12=0𝑃12𝑃12𝑃12𝑃12𝑃12𝑃120𝑛×𝑛,𝑄𝑖𝑖𝑄=diag𝑖𝑖,,𝑄𝑖𝑖𝑛×𝑛𝑅,𝑖=1,2,𝑖𝑖𝑅=diag𝑖𝑖,,𝑅𝑖𝑖𝑛×𝑛,𝑖=1,2.(18) With appropriate dimensions, the following two zero equations hold: 𝜙1=2𝐳𝑇𝑁̂𝐞(𝑡)𝑡𝑡𝜏̇̂̂𝜙𝐞(𝑠)𝑑𝑠𝐞(𝑡𝜏)=0,2=2𝐳𝑇𝑀̇̂𝐞̂𝐞̂𝐞(𝑡)+𝐾(𝑡)+𝐴(𝑡𝜏)=0,(19) where ̂̂̇̂𝐳=𝐞(𝑡),𝐞(𝑡𝜏),𝐞(𝑡),𝑡𝑡𝜏̂𝐞(𝑠)𝑑𝑠,𝑡𝑡𝜏̇̂𝐞(𝑠)𝑑𝑠𝑇,𝑁𝑁=1,𝑁2,𝑁3,𝑁4,𝑁5𝑇,𝑁𝑖𝑛=diag𝑖,,𝑛𝑖𝑛×𝑛𝑀,𝑖=1,,5,𝑀=1,𝑀2,𝑀3,𝑀4,𝑀5𝑇,𝑀𝑖𝑚=diag𝑖,,𝑚𝑖𝑛×𝑛[],𝑖=1,,5,𝐾=diag𝐤,,𝐤𝑛×𝑛,𝐴=0𝑎12𝑎1(𝑛1)𝑎1𝑛𝑎210𝑎2(𝑛1)𝑎2𝑛𝑎(𝑛1)1𝑎(𝑛1)20𝑎(𝑛1)𝑛𝑎𝑛1𝑎𝑛2𝑎𝑛(𝑛1)0.(20) Then, the derivative of the multiple Lyapunov function candidate is as follows: ̇̇𝑉=𝑉+𝜙1+𝜙2̇̂𝐞=(𝑛1)𝑇(𝑃𝑡)11̂̂𝐞𝐞(𝑡)+(𝑛1)𝑇(𝑃𝑡)11̇̂̇̂𝐞𝐞(𝑡)+2𝑇𝑃(𝑡)12𝑡𝑡𝜏̂̂𝐞𝐞(𝑠)𝑑𝑠+2𝑇𝑃(𝑡)12̂̂𝐞𝐞(𝑡)2𝑇𝑃(𝑡)12̂̂𝐞𝐞(𝑡𝜏)+(𝑛1)𝑇𝑃(𝑡)22𝑡𝑡𝜏̂̂𝐞𝐞(𝑠)𝑑𝑠(𝑛1)𝑇𝑃(𝑡𝜏)22𝑡𝑡𝜏̂𝐞(𝑠)𝑑𝑠+(𝑛1)𝑡𝑡𝜏̂𝐞𝑇𝑃(𝑠)𝑑𝑠22̂𝐞(𝑡)(𝑛1)𝑡𝑡𝜏̂𝐞𝑇𝑃(𝑠)𝑑𝑠22̂̂𝐞𝐞(𝑡𝜏)+(𝑛1)𝑇𝑄(𝑡)11̂̇̂𝐞𝐞(𝑡)+(𝑛1)𝑇𝑄(𝑡)22̇̂̂𝐞𝐞(𝑡)(𝑛1)𝑇𝑄(𝑡𝜏)11̂̇̂𝐞𝐞(𝑡𝜏)(𝑛1)𝑇𝑄(𝑡𝜏)22̇̂̂𝐞𝐞(𝑡𝜏)+𝜏(𝑛1)𝑇𝑅(𝑡)11̂̇̂𝐞𝐞(𝑡)+𝜏(𝑛1)𝑇𝑅(𝑡)22̇̂𝐞(𝑡)(𝑛1)𝑡𝑡𝜏̂𝐞𝑇̇̂𝐞(𝑠),𝑇𝑅(𝑠)1100𝑅222𝑛×2𝑛̂̇̂𝐞(𝑠)𝐞(𝑠)𝑑𝑠+2𝐳𝑇𝑁̂𝐞(𝑡)𝑡𝑡𝜏̇̂̂𝐞(𝑠)𝑑𝑠𝐞(𝑡𝜏)+2𝐳𝑇𝑀̇̂̂̂.𝐞(𝑡)+𝐾𝐞(𝑡)+𝐴𝐞(𝑡𝜏)(21) Using Lemma 1, we have ̇̇̂𝐞𝑉(𝑛1)𝑇𝑃(𝑡)11̂̂𝐞𝐞(𝑡)+(𝑛1)𝑇𝑃(𝑡)11̇̂̇̂𝐞𝐞(𝑡)+2𝑇𝑃(𝑡)12𝑡𝑡𝜏̂̂𝐞𝐞(𝑠)𝑑𝑠+2𝑇𝑃(𝑡)12̂̂𝐞𝐞(𝑡)2𝑇𝑃(𝑡)12̂̂𝐞𝐞(𝑡𝜏)+(𝑛1)𝑇𝑃(𝑡)22𝑡𝑡𝜏̂̂𝐞𝐞(𝑠)𝑑𝑠(𝑛1)𝑇𝑃(𝑡𝜏)22𝑡𝑡𝜏̂𝐞(𝑠)𝑑𝑠+(𝑛1)𝑡𝑡𝜏̂𝐞𝑇𝑃(𝑠)𝑑𝑠22̂𝐞(𝑡)(𝑛1)𝑡𝑡𝜏̂𝐞𝑇𝑃(𝑠)𝑑𝑠22̂̂𝐞𝐞(𝑡𝜏)+(𝑛1)𝑇𝑄(𝑡)11̂̇̂𝐞𝐞(𝑡)+(𝑛1)𝑇𝑄(𝑡)22̇̂̂𝐞𝐞(𝑡)(𝑛1)𝑇𝑄(𝑡𝜏)11̂̂𝐞𝐞(𝑡𝜏)+𝜏(𝑛1)𝑇𝑅(𝑡)11̂̇̂𝐞𝐞(𝑡)+𝜏(𝑛1)𝑇𝑅(𝑡)22̇̂𝐞(𝑡)𝑛1𝜏𝑡𝑡𝜏̂𝐞𝑇𝑅(𝑠)𝑑𝑠11𝑡𝑡𝜏̂𝐞(𝑠)𝑑𝑠𝑛1𝜏𝑡𝑡𝜏̇̂𝐞𝑇𝑅(𝑠)𝑑𝑠22𝑡𝑡𝜏̇̂𝐞(𝑠)𝑑𝑠+2𝐳𝑇𝑁̂𝐞(𝑡)𝑡𝑡𝜏̇̂̂𝐞(𝑠)𝑑𝑠𝐞(𝑡𝜏)+2𝐳𝑇𝑀̇̂̂̂𝐞(𝑡)+𝐾𝐞(𝑡)+𝐴𝐞(𝑡𝜏)=𝐳𝑇𝐻𝐳,(22) where 𝐻 is shown in (13). If (13) holds, then from (22), we have ̇𝑉0 which means that the system (11) is asymptotically stable, for example, 𝐞𝑖(𝑡) tends to zero asymptotically which means the 𝑖th robot in the group tracks its desired trajectory well.

Note that the LMI condition in (13) is nonconvex, and hence the following theorem is proposed to be the sufficient condition of (13).

Theorem 3. Consider the error dynamics model represented by (11), for a given time delay 𝜏, given scalars 𝜃𝑖, 𝑖=1,,5 and the number of members in one group 𝑛, if there exist matrices 𝑃11, 𝑃12, 𝑃22, 𝑄11, 𝑄22, 𝑅11, 𝑅22, 𝑋, 𝑌, 𝑁𝑖,𝑖=1,,5 with appropriate dimensions, such that the following inequality holds: 𝐻11𝐻21𝐻22𝐻31𝐻32𝐻33𝐻41𝐻42𝐻43𝐻44𝐻51𝐻52𝐻53𝐻54𝐻55<0,(23) where 𝐻11=𝑃12+𝑃𝑇12+(𝑛1)𝑄11+(𝑛1)𝜏𝑅11+𝑁1+𝑁𝑇1+𝜃1𝑌+𝜃1𝑌𝑇,𝐻21=𝑃𝑇12+𝑁2𝑁𝑇1+𝜃2𝑋𝐴𝑇+𝜃2𝑌,𝐻22=(𝑛1)𝑄11𝑁2𝑁𝑇2+𝜃2𝐴𝑋𝑇+𝜃2𝑋𝐴𝑇,𝐻31=(𝑛1)𝑃11+𝑁3+𝜃𝑇1𝑋+𝜃3𝑌,𝐻32=𝑁3+𝜃3𝐴𝑋𝑇+𝜃2𝑋,𝐻33=(𝑛1)𝑄22+(𝑛1)𝜏𝑅22+𝜃3𝑋𝑇+𝜃3𝑋,𝐻41=(𝑛1)𝑃22+𝑁4+𝜃4𝑌,𝐻42=(𝑛1)𝑃22𝑁4+𝜃4𝐴𝑋𝑇,𝐻43=𝑃𝑇12+𝜃4𝑋𝑇,𝐻52=𝑁𝑇2𝑁5+𝜃5𝐴𝑋𝑇,𝐻51=𝑁𝑇1+𝑁5+𝜃5𝑌,𝐻44=(𝑛1)𝑅11𝜏,𝐻53=𝑁𝑇3+𝜃5𝑋𝑇,𝐻54=𝑁𝑇4,𝐻55(=𝑛1)𝑅22𝜏𝑁5𝑁𝑇5,(24) then system (11) is asymptotically stable with control gain 𝐾=𝑌𝑋1, for example, 𝐞𝑖(𝑡) tends to zero asymptotically which means the 𝑖𝑡 robot in the group tracks its desired trajectory well.

Proof. In order to transform the nonconvex LMI in (13) into a solvable LMI, assume that 𝑀𝑖=𝜃𝑖𝑀0,𝑖=1,,5 where 𝜃𝑖 is known and given. Define 𝑋=𝑀01, 𝑊=diag(𝑋,𝑋,𝑋,𝑋,𝑋), and 𝑌=𝐾𝑋. Then by premultiplying the inequality in (13) by 𝑊𝑇 and postmultiplying by 𝑊, we can obtain the inequality (23).

Remark 4. Equation (23) in Theorem 3 and (13) in Theorem 2 are used to design control gain 𝐾. Equation (23) is a sufficient condition of (13) in Theorem 2 due to the simplification of 𝑀𝑖 matrices.

5. Simulations

In this subsection, three robots in the group move with a constant delay at 1 second is simulated. In effect, the proposed approach is applicable for any group with multiple robotic systems (greater than three).

The consensus control algorithm in (8) has been applied to adjust the whole group movement performance. The control gain has been designed based on the sufficient condition in Theorem 3 as 𝐾𝑖=𝑌𝑋1=5.6681005.6681,(25) where ,,𝑋=0.0654000.0654𝑌=0.3705000.3705(26)𝑖[1,2,3].

The evolution of the group movement has been shown in Figure 4. For robot 1, the desired trajectory is a linear function, 𝑥𝑑1=60𝑡 + 250; 𝑦𝑑1=𝑡. For robot 2, it is 𝑥𝑑2=𝑡 + 4; 𝑦𝑑2=𝑡. And for robot 3, it is 𝑥𝑑3=𝑡; 𝑦𝑑3=𝑡+12. The initial positions for three robots are arranged by every 2cm at 𝑋-axis with 0 mm at 𝑌-axis. Robots 1 and 2 start moving at (4,0) and (6,0), respectively, while robot 3 starts at (8,0) position. As shown in Figure 4 at 1 second after the group starts moving, the initial position information of each robot at 𝑡=0 second has not been received by each other. Since the time increment is measured as 0.2 seconds, at the 0.4 seconds, three robots sufficiently started to move toward the desired trajectory from the original positions. In 𝑡=1 second, the robots have received the signals between each other, due to the communication delay. Finally, they reached the desired formation after a certain time.

150250.fig.004
Figure 4: Evolution of the robot group movement with long-time communication delay (𝜏=1second).

In Figure 5, the tracking error figure shows the tracking error in X- and 𝑌-axis versus time, respectively. Because the tracking error at 𝑋-axis corresponded to the 𝑌-axis in term of magnitude, it is accurately sufficient to focus on the tracking error at 𝑋-axis only. From this figure, at 𝑡=0 second, the tracking errors which are measured at 𝑋-axis for robot 3 are highest, approximately 8 cm until the time past 𝑡=1 second, which is the time the robots received the signal. Since the control gain was designed well to reduce the effect caused by the delay, the tracking errors gradually converged to zero in the next 2.5 seconds.

fig5
Figure 5: The tracking error of the robot group movement with time delay (𝜏=1second): (a) 𝑋-axis; (b) 𝑌-axis.

To further test the stabilization ability of the proposed control approach, the virtual leaders’ trajectories are adopted as nonlinear curve, which is different compared with those in the previous section. For robot 1, the desired trajectory is 𝑥𝑑1=𝑡; 𝑦𝑑1=sin(0.5𝑡). For robot 2, it is 𝑥𝑑2=𝑡; 𝑦𝑑2=sin(0.5𝑡)+0.5. And for robot 3, it is 𝑥𝑑2=𝑡; 𝑦𝑑3=sin(0.5𝑡)+1.

The evolutions of the group movement is as shown in Figure 6. From the figure, it can be seen that finally the group tracks the virtual leaders’ trajectory and maintains the desired group formation very well. The tracking errors have been represented in Figure 7 based on both X- and 𝑌-axis. As shown in Figure 7, the tracking errors converge to zero in 2.5 seconds which shows the effectiveness of the proposed consensus control algorithm. It can make the whole networked multirobots reach consensus and maintain the desired group formation well. It also can reduce the effects caused by communication delays.

150250.fig.006
Figure 6: Evolution of the group movement with nonlinear formation with time delay (𝜏=1second).
fig7
Figure 7: Tracking errors of the group with time delay (𝜏=1second): (a) 𝑋-axis; (b) 𝑌-axis.

6. Experimental Results

In this section, the proposed distributed formation control strategy is applied to multiple mobile robots for experimental tests. As shown in the following subsections, there are three main parts: (i) the hardware experimental setup; (ii) the software regarding the control operation system of P3 mobile robots; (iii) discussions on the experimental results.

6.1. Implementation of the Proposed Approach

Experimental tests are implemented in the Advanced Control and Mechatronics Laboratory at Dalhousie University. The multiple mobile robot test platform consists of one Pioneer 3-DX and one Pioneer 3-AT as shown in Figure 8. The two robots are connected with two laptops through serial ports, and the two laptops can communicate with each other through wireless network with TCP/IP protocols. Each robot has encoder for their position and orientation information. All calculations, receiving data information from the robots and inputting control signals to the robots, are processed by the laptops.

150250.fig.008
Figure 8: Pioneer 3 mobile robot test platform framework.

In the experimental tests, a group of two P3 mobile robots is required to maintain the desired group formation according to its desired trajectory. The kinematic model for each robot is as shown in (1), and this model can be linearized by setting a hand position for each robot, for example, the simplified model represented by (5). After the group starts moving, laptops attached on the robots will keep performing the following tasks once per second: (1) reading position and orientation data from robots; (2) exchanging those data with each other through the wireless network with 1 second communication delay; (3) calculating the control input values according to the distributed consensus formation control algorithm (8) and then calculating the desired linear and orientation speed for the robots according to (4); (4) converting the desired linear and orientation speed of the robots into the desired rotating speed of the left and right wheel of the robots, respectively, based on the following equation: 𝜐𝑅=𝜔,𝑉𝐿,𝑉=𝜔𝑅0.5𝑙𝑅,=𝜔𝑅+0.5𝑙(27) where 𝑉𝐿 and 𝑉𝑅 are the left and right wheels rotating speed of the robot, 𝑙=33 cm is the length between left and right wheels of Pioneer 3-DX, and 𝑙=38 cm is that of Pioneer 3-AT, (5) sending signals to robots to set the rotating speeds as the desired values.

6.2. Introduction on Software

In the experimental tests, software programming is another important issue. All commands and calculations processed by the controller (laptop) attached on each robot are programmed in C++ language. For simplifying the programming task, advanced robot interface for applications (ARIAs) has been used in the work.

ARIA is a programming library for C++ programmers who want to access their mobile robot platform and accessories at either a high or low level. Written in the C++ language, ARIA is client-side software for easy, high-performance access to and management of the robot, as well as to the many accessory robot sensors and effectors. ARIA includes many useful utilities for general robot programming and cross-platform (Linux and Windows) programming as well.

ARIA can dynamically control the robot’s velocity, heading, relative heading, and other motion parameters either through simple low-level commands or through its high-level “actions” infrastructure. In this work, ARIA also receives odometric position estimates, sonar readings, and all other current operating data sent by the robot platform. Functions defined in ARIA have been invoked to help read position data and set robot’s velocity and orientations, which as a result saves lots of time in programming.

Since the two laptops are required to communicate with each other via the wireless network with TCP/IP topology, a library named ArSocket in ARIA is then used for this issue. With the help of ArSocket, the user can directly create a server with one laptop and create a client with another. At the beginning of the group movement, the server opens a server port for the client and waits for the client to connect. The client is then connected to the server by following the server’s IP address. When the server receives the client’s call, it will send a call back to the client and start action. Then the client will start action as soon as it receives the call from the server. The server and client can interact synchronously through this way.

6.3. Experimental Results

The two robots in the team start moving at initial position of (0,0) for robot 1 (P3-AT) and (1050,1050) for robot 2 (P3-DX) with a unit in mm. As described above, the hand position for each robot has a distance 𝐿 to the center point of the robot. In the experiment, 𝐿=30 cm for both robots, so the initial hand positions of robot 1 and robot 2 are (300,300) and (1350,1350), respectively, with a unit in mm. For the first test, the “hands” of the robot group are firstly required to track a straight line as 𝑥𝑑(𝑡)=60𝑡+500,𝑦𝑑(𝑡)=60𝑡+500,(28) where 𝑡 is the time starting from 0 second, the unit of 𝑥𝑑 and 𝑦𝑑 is mm, and (28) is according to the coordinate system 𝐶𝑖 of the 𝑖th robot itself. The group movement trajectory is as shown in Figure 9.

fig9
Figure 9: Experimental result of group movement tracking straight line: (a) 0 second; (b) 20 seconds; (c) 40 seconds; (d) 60 seconds.

In order to evaluate the group performance, the group movement trajectory was recorded and analyzed using MATLAB. The group trajectory is drawn by Figure 10. Since the position data has been recorded once per second, the time period between each location point in the figure is 1 second. As shown in the figure, P3-AT and P3-DX start moving from initial positions together at 0 second. The group starts getting close to the virtual leader’s trajectory or the desired trajectory in the first 8 seconds of the movement. After 8 seconds, the group gets on the desired trajectory. During this process, the desired group formation has been kept very well. Figure 11 shows that the consensus tracking errors for the virtual center position converge more and more close to 0, and the lowest values of the errors are below 2cm. This convergence property of the tracking error guarantees the good maintenance of the group formation.

150250.fig.0010
Figure 10: Group movement tracking straight line.
150250.fig.0011
Figure 11: Consensus tracking errors for the virtual position: straight line case.

For the second test, the group is required to track a curve as 𝑥𝑑(𝑡)=20𝑡+500,𝑦𝑑(𝑡)=2𝑡2+500,(29) where 𝑡 is the time starting from 0 second, the unit of 𝑥𝑑 and 𝑦𝑑 is mm, and (29) is according to the coordinate system 𝐶𝑖 of the 𝑖th robot itself. The team movement with fixed group formation is as shown in Figure 12.

fig12
Figure 12: Experimental result of group movement tracking curve: (a) 0 second; (b) 7 seconds; (c) 20 seconds; (d) 35 seconds.

For this case, the data has also been recorded and analyzed. Figure 13 shows the group movement trajectory and virtual leader trajectory. As shown in the Figure, the group trajectory of each robot undulates a little bit in the first 8 seconds transition time compared with the previous test as in Figure 10. After 8 seconds, the group gets on desired trajectory and undulates a little bit more than the previous test (the straight line case). Through drawing the consensus tracking errors for virtual center positions in Figure 14, it shows that the tracking error of each robot converges in the first 20 seconds and the minimum value is below 2cm. And then after 20 seconds, it increases a little bit between 2cm and 3cm. That is because the motor speed of each robot, which is calculated and set by the controller once per second, is held for each 1 second during the movement. So the system is not “ideal time continuous.” For the curve tracking case, the virtual leader of each robot moves with an acceleration along 𝑌-axis which is equal to 4 mm/s2. As the time goes after movement, the virtual leader’s velocity increases greatly and becomes bigger and bigger so that it becomes more and more difficult for each robot to react and match the velocity and motion of its virtual leader. This hardware limitation causes the performance of the consensus tracking errors as shown in Figure 14. If the group moves for over 200 seconds, then the speed of the virtual leader along 𝑌-axis becomes more than 0.8 meters per second which is the maximum speed of P3-AT. This is the main difference compared with the previous test (straight line case).

150250.fig.0013
Figure 13: Group movement tracking curve.
150250.fig.0014
Figure 14: Consensus tracking errors for the virtual position: curvilinear case.

From the results, the consensus-based formation control strategies described in Section 4 are applied to the experimental test for P3 robot group. Due to the proper design of the control gain, the mobile robot group can track the virtual leader’s trajectory and maintain the desired group formation well.

7. Conclusions

In this work, a consensus-based tracking control strategy was proposed for the virtual leader formation control approach of multiple mobile-robot group with group communication delays. The kinematic model of P3 mobile robot has been introduced. The formation control algorithm has been applied to the linearized dynamic model of P3 mobile robot. A novel multiple Lyapunov functional candidate has been proposed to give the sufficient conditions of the control gain design as shown in theorems. The proposed consensus formation control strategy can be successfully applied to the multiple P3 mobile-robot experimental platform in the host laboratory. The results show a good group performance due to the good feasibility of the proposed approach.

Acknowledgments

The authors would like to thank NSERC and CFI Canada for the funding support.

References

  1. T. R. Smith, H. Hmann, and N. E. Leonard, “Orientation control of multiple underwater vehicles,” in Proceedings of 40th Conference on Decision and Control, vol. 5, pp. 4598–4603, Orlando, Fla, USA, 2001.
  2. L. E. Buzogany, M. Pachter, and J. J. Azzo, “Automated control of aircraft in formation flight,” in Proceedings of American Institute of Aeronautics and Astronautics Conference Guidance, Navigation and Control (AIAA '01), pp. 4598–4603, Monterey, Calif, USA, 2001.
  3. C. A. Kitts and I. Mas, “Cluster space specification and control of mobile multirobot systems,” IEEE/ASME Transactions on Mechatronics, vol. 14, no. 2, pp. 207–218, 2009. View at Publisher · View at Google Scholar · View at Scopus
  4. W. B. Dunbar and R. M. Murry, “Model predictive control of coordinated multi-vehicle formations,” in Proceedings of the Conference on Decision and Control, pp. 4631–4636, Las Vegas, Nev, USA, 2002.
  5. W. B. Dunbar and R. M. Murray, “Distributed receding horizon control for multi-vehicle formation stabilization,” Automatica, vol. 42, no. 4, pp. 549–558, 2006. View at Publisher · View at Google Scholar · View at Scopus
  6. H. Yamaguchi, “Cooperative hunting behavior by mobile-robot troops,” International Journal of Robotics Research, vol. 18, no. 9, pp. 931–940, 1999. View at Scopus
  7. B. Mohar, “The laplacian spectrum of graphs,” in Graph Theory, Combinatorics and Applications, vol. 2, pp. 871–898, 1991.
  8. R. Merris, “Laplacian matrices of graphs: a survey,” Linear Algebra and Its Applications, vol. 197, pp. 143–176, 1994. View at Scopus
  9. A. Franchi, L. Freda, G. Oriolo, and M. Vendittelli, “The sensor-based random graph method for cooperative robot exploration,” IEEE/ASME Transactions on Mechatronics, vol. 14, no. 2, pp. 163–175, 2009. View at Publisher · View at Google Scholar · View at Scopus
  10. S. Khoo, L. Xie, and Z. Man, “Robust finite-time consensus tracking algorithm for multirobot systems,” IEEE/ASME Transactions on Mechatronics, vol. 14, no. 2, pp. 219–228, 2009. View at Publisher · View at Google Scholar · View at Scopus
  11. C. A. C. Parker and H. Zhang, “Cooperative decision-making in decentralized multiple-robot systems: the best-of-N problem,” IEEE/ASME Transactions on Mechatronics, vol. 14, no. 2, pp. 240–251, 2009. View at Publisher · View at Google Scholar · View at Scopus
  12. 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
  13. R. Olfati-Saber and R. M. Murray, “Consensus problems in networks of agents with switching topology and time-delays,” IEEE Transactions on Automatic Control, vol. 49, no. 9, pp. 1520–1533, 2004. View at Publisher · View at Google Scholar · View at Scopus
  14. P. Wang, “Navigation strategies for multiple autonomous mobile robots moving in formation,” Journal of Robotic Systems, vol. 8, no. 2, pp. 177–195, 1991. View at Scopus
  15. A. Viguria and A. M. Howard, “An integrated approach for achieving multirobot task formations,” IEEE/ASME Transactions on Mechatronics, vol. 14, no. 2, pp. 176–186, 2009. View at Publisher · View at Google Scholar · View at Scopus
  16. M. Egerstedt, X. Hu, and A. Stotsky, “Control of mobile platforms using a virtual vehicle approach,” IEEE Transactions on Automatic Control, vol. 46, no. 11, pp. 1777–1782, 2001. View at Publisher · View at Google Scholar · View at Scopus
  17. S. Xu and J. Lam, “A survey of linear matrix inequality techniques in stability analysis of delay systems,” International Journal of Systems Science, vol. 39, no. 12, pp. 1095–1113, 2008. View at Publisher · View at Google Scholar · View at Scopus
  18. 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
  19. H. K. Khalil, Nonlinear Systems, Prentice Hall, Englewood Cliffs, NJ, USA, 1996.
  20. S. Boyd, L. El Ghaoui, E. Feron, and V. Balakrishnan, Linear Matrix Inequalities in System and Control Theory, vol. 15 of Studies in Applied Mathematics, 1994.
  21. Y. Cao and W. Ren, “Distributed coordinated tracking with reduced interaction via a variable structure approach,” IEEE Transactions on Automatic Control, vol. 57, no. 1, pp. 33–48, 2012.