Mathematical Problems in Engineering

Volume 2013, Article ID 597195, 8 pages

http://dx.doi.org/10.1155/2013/597195

## Robust Coordinated Control Algorithm for Multiple Marine Vessels with External Disturbances

^{1}Bohai University, Jinzhou 121013, China^{2}Department of Engineering, Faculty of Engineering and Science, University of Agder, 4898 Grimstad, Norway^{3}No. 803 Research Institute of Shanghai Academy of Spaceflight Technology, No. 710 Yishan Road, Shanghai 200233, China

Received 16 August 2013; Accepted 23 September 2013

Academic Editor: Zhiguang Feng

Copyright © 2013 Weixue Liu 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

The problem of coordinated control for multiple marine vessels in the presence of external disturbances is considered in this paper. A robust coordinated control algorithm is proposed for multiple marine vessels. The proposed robust coordinated control algorithm is divided into two parts. The first part develops an extended state observer to estimate the disturbances of marine vessels. The second part presents a robust coordinated control algorithm based on the output of the extended state observer. Furthermore, the robust coordinated control algorithm is designed using the dynamic surface control method. In light of the leader-follower strategy, the trajectory for each vessel is defined according to the desired trajectory of the assigned leader and the relative distance with respect to the leader. The effectiveness of the proposed coordination algorithm is demonstrated by the simulation results.

#### 1. Introduction

In recent years, coordinated control of multiple vehicles has received increasing attention as an emerging technology [1]. Multiple vehicles can perform many complex tasks effectively with less time and lower cost than a single vehicle. And multiple vehicles can accomplish some tasks which cannot be executable by a single one. In order to perform these complicated practical tasks, it is necessary for these vehicles to move collectively as a whole formation. In practice, many relevant applications of coordinated control can be found on the land, in the sea, and in the air [2]. For instance, in the operations of underway replenishment by a fleet of surface vessels, it is required that the replenished vehicle should maintain a fixed relative position with respect to the replenishing one, in order to ensure the replenishment operation performed safely and effectively.

The problem of coordinated formation control has been reported in a large number of recent publications. Basic approaches of the coordinated control include leader-follower approach [3–5], behavioral approach [6, 7], and virtual structures approach [8, 9]. In the leader-follower approach, some agents are considered as the leaders, and the rest ones are considered as the followers. The followers will track the leaders, and the leaders will track the predefined desired trajectories. This method is easy to be manipulated and implemented. However, the main criticism of the leader-follower approach is that it depends heavily on the leader to achieve the goal of the formation task which may be undesirable [3–5]. In the behavioral approach, the collision avoidance/obstacle avoidance and the target tracking are prescribed for each agent, and the whole formation is achieved by calculating the weight of the relative importance of each behavior. However, it is difficult to analyze the stability of the group behavior using such approach [6, 7]. In the virtual-structure approach, each member in the formation is considered as a particle embedded in a rigid geometric structure, but the relative applications are limited when the formation structure is time-varying or needs to be frequently reconfigured [8, 9].

Some advanced approaches including graph theory [10], passivity-based control [11, 12], and hybrid control [13] are also used for coordinated control of multiple marine vessels. Most results about the coordinated control problem addressed in the earlier papers are on the assumption that marine vessels are free from environmental disturbances. However, coordinated control for multiple surface vessels encountering exogenous disturbances adds a new level of complexity to the problem. Other advanced methods are proposed to solve the robust coordinated formation control problem, for example, the Lagrangian approach [14], the nonlinear model predictive control [15], the adaptive control [16], and the sliding mode control [17]. In addition, the fault tolerant control and the fault diagnosis are studied in references [18–20]. In particular, the problem of coordinated path following multiple vessels has also been discussed in the related literature studies [21, 22]. The robustness to environmental disturbances is highly important when performing practical marine and offshore tasks for surface vessels, which is also the concerned issue in this paper. The core of the extended state observer is that the disturbances and the unknown dynamics can be considered as extend state, and then the detailed values can be estimated by designed observer. The correlative applications can be found in literature studies [23–26]. The stability of the extended state observer is analyzed in [27–29]. The robust coordination control algorithm for multiple surface vessels based on extend state observer and robust control technology is studied in this paper. The designed controller is useful for the practical marine operations.

In this paper, we consider the problem of coordinated formation control of multiple surface vessels in the presence of exogenous disturbances. The coordinated formation controller is proposed by combining the extended state observer and dynamic surface control using the leader-follower strategy. The extended state observer is developed to estimate the external disturbances of the surface vessels. The coordinated control algorithm is accomplished based on the output of the extended state observer. Furthermore, the trajectory of each vessel is defined using the desired trajectory of the assigned leader and the relative distance with respect to the leader. This paper is organized as follows. In Section 2, the vessel model is established. Section 3 contains a detailed algorithm of the coordination formation control for multiple vessels. Simulation is carried out in Section 4, and we draw conclusions in Section 5.

#### 2. Preliminaries

The vessel model can be divided into two parts: the kinematics and nonlinear dynamics. Generally, only the motion in the horizontal plane is considered for the surface vessel. The elements corresponding to heave, roll, and pitch are neglected. The dynamic model for the *i*th surface vessel can be represented by the following 3 degrees of freedom (DOF) [30]:
where denotes the north position, east position, and orientation which are decomposed in the Earth-fixed reference frame, denotes the linear surge velocity, sway velocity, and angular velocity which are decomposed in the body-fixed reference frame. is the transformations matrix from the body-fixed reference frame to the Earth-fixed reference frame, the form of which is as follows:
The transformations matrix satisfies , for all . denotes the system inertia mass matrix including added mass which is positive definite. and denote the Coriolis-centripetal matrix and damping matrix, respectively. The detailed representation of the above three system matrices can be found in reference [30]. is the vector of forces and torques input from the thruster system. is the vector of external environment forces and torques input which is generated by wind, wave, and current.

In order to design the backstepping sliding mode controller, we transform the vessel model as follows: because , where with being the angular velocity in the body-fixed reference frame. We can obtain that Taking (4) and (6) into the vessel dynamic model (2) yields The above equation can be written as where

#### 3. Coordinated Formation Controller Design

In this section, the controller is designed from two inspects. One is the extended state observer design for each vessel, and the other is the coordinated controller for multiple vessels based on the output of the extended state observer.

##### 3.1. Extended State Observer Design

In this section, we design the extended state observer for each vessel to estimate the disturbances.

Let , and then (8) can be written as Then we have

Let . Then the above equation can be rewritten as Here is assumed to be unknown. We assume that is an extended state. However, can be estimated using an extended state observer. Then the disturbances are observed and compensated by the designed controller.

The extended state observer is designed as where And , .

Set , , . are the estimated values of , respectively. Taking the derivative of , respectively, we can obtain that

The following assumptions are presumed.(1) The possibly unknown function is continuously differentiable with respect to their variables. for all , where is a positive constant.(2) Let , and denotes the Euclid norm of . There exist positive definite constants , and continuous differentiable functions such that(i) , ,(ii),(iii) .

The stability for the extended state observer is analyzed in [24]. Then we can obtain , , .

##### 3.2. Coordinated Controller Design

###### 3.2.1. Formation Setup

This paper considers a fleet of n vessels to perform the desired coordination formation task. Each vessel in the formation is identified by the index set . The desired formation is established using the leader-follower strategy as shown in Figure 1. Furthermore, the leader is a virtual vessel. If we assume the desired trajectory of the leader vessel is denoted as , where , , are sufficiently smooth functions, and . That means the vessel direction is chosen as the tangential vector of the respective desired trajectory. If we define the relative distance between the follower vessel and the leader vessel as , then the desired trajectory of the follower vessel is denoted as .

###### 3.2.2. Controller Design

Define the first dynamic surface as Taking the derivative of the first surface, with (13), we obtain Define a virtual velocity as follows: where is a positive definite matrix. With this definition, if , then . Then with a convergence rate determined by the choice of . Because of the definition of , this will also guarantee that .

is passed through a first order filter in order to avoid the problem existed in the backstepping scheme: where is a diagonal matrix of the filter time constants which are chosen to be as small as possible. Because , then we can define the second sliding surface as where is the estimated value of ; take the derivative of , then we have Taking the derivative of the second surface, with (13), we have We consider the following Lyapunov function candidate: We take the time derivative of (25): So we choose the control input as .

The control input of the vessel is . So the control force input is selected as

Theorem 1. *Consider the vessel with the nonlinear model as in (1), (2), and (8), with the control law (27), and then one can guarantee that the vessels approach the desired trajectory ultimately while holding the desired formation structure. *

*Proof. *With the definition of the second surface, (19) can be rewrite as
Define the estimated error of the first order filter as
Taking the derivative of yields
With (19) and (21), we obtain
Define the Lyapunov function as
Differentiating the above equation yields
If we define the maximum of is , we can know that , is a positive constant. Then we can obtain that . Let , and the filter time constant can be chosen as ; then we can obtain that
If we choose , then . We can guarantee that . This implies , in turn, and .

#### 4. Simulation Results

In this section, experimental simulations are carried out to evaluate the effectiveness of the proposed coordinated formation control algorithm. The detailed parameters of the vessel are presented in the literature [11]. At the beginning, the proposed extended state observer of one vessel is evaluated by the simulation. Similarly, the performance of the extended state observer of other vessels is achieved. Compare with the existing literature studies, we let the initial position of the vessel is . The vessel moves in a beeline northward. assume that the vessels encounter the wind, wave, and current. The wind is assumed to be fixed direction and fixed velocity, and then the disturbance of wind is a constant; the wave and current are assumed to be the sine wave with a fixed frequency at one time. The external disturbances can be chosen as In the simulation, we assume that the external disturbances are unknown. The proposed observer parameters are selected as , , , , and .

The simulation results are shown in Figures 2 to 5. Figure 2 shows the movements for the vessel in the plane. The practical value and estimated value of the north position, east position, and heading change curve of the vessel are shown in Figure 3. Figure 4 shows the practical value and estimated value of the surge velocity, sway velocity, and angular velocity of the vessel. The estimated value of the external disturbances are shown in Figure 5. In the simulation experiment, there is no measurement noise in the kinematics and nonlinear dynamics. So the practical value and estimated value of the position and velocity are consensus in a way. What’s more, the external disturbances can be estimated through introducing the extended state.

Then we evaluate the effectiveness of the proposed robust coordinated formation control algorithm. Three surface vessels are considered to perform the coordinated tracking task. The initial positions of the three vessels are , and , respectively. In order to evaluate the performance of the coordinated tracking, the desired formation pattern of the coordinated formation controller is described by , , and . The desired trajectory for the assigned leader is chosen as , and the detailed forms are , , . The proposed controller parameters are selected as , , and .

The simulation results are shown in Figures 6 to 10. Figure 6 shows the movements for these vessels in the plane. The heading change curve of each vessel is shown in Figure 7. Figures 8, 9, and 10 show the surge velocity, the sway velocity, and the angular velocity of each vessel during the coordinated control process, respectively. We can see that these vessels realized the coordinated tracking task from Figures 6 and 7. From Figures 8, 9, and 10, the velocities of these vessels achieve consensus as a whole, and the velocities cannot achieve consensus absolutely when the vessels move to the inflexion of the curves. With the analysis of the simulation results, we can conclude that these vessels can accomplish coordinated trajectory tracking task while keeping the desired formation. It means that the proposed coordination control algorithm is effective.

#### 5. Conclusion

This paper has proposed a new robust coordinated formation control algorithm for multiple surface vessels in the presence of external environmental disturbances. The proposed coordinated formation controller for these vessels is designed by combining the extended state observer and the dynamic surface control together. The extended state observer is designed to estimate the external disturbances of the surface vessels. The coordinated formation is realized based on the leader-follower strategy. The desired trajectory of each vessel is defined using the desired trajectory of the assigned leader and relative distance with respect to the leader. The controller is designed based on the output of the extended state observer and using the dynamic surface control method. The proposed coordinated controller is robust to the external disturbances. Finally, the effectiveness of the proposed robust coordination control algorithm is demonstrated by the simulation results.

#### Conflict of Interests

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

#### Acknowledgment

The authors would like to acknowledge the support of the Natural Science Grant of Liaoning Province (2013020002).

#### References

- W. Ren, R. W. Beard, and E. M. Atkins, “A survey of consensus problems in multi-agent coordination,” in
*Proceedings of the American Control Conference*, pp. 1859–1864, June 2005. View at Scopus - A. Aguiar, J. Almeida, M. Bayat et al., “Cooperative autonomous marine vehicle motion control in the scope of the EU GREX Project: theory and practice,” in
*Proceedings of the IEEE Bremen: Balancing Technology with Future Needs (OCEANS '09 )*, pp. 1–10, May 2009. View at Publisher · View at Google Scholar · View at Scopus - P. K. C. 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 Google Scholar · View at Scopus - J. K. Hedrick, M. Tomizuka, and P. Varaiya, “Control issues in automated highway systems,”
*IEEE Control Systems Magazine*, vol. 14, no. 6, pp. 21–32, 1994. View at Publisher · View at Google Scholar · View at Scopus - M. Breivik, V. E. Hovstein, and T. I. Fossen, “Ship formation control: a guided leader-follower approach,” in
*Proceedings of the 17th World Congress, International Federation of Automatic Control (IFAC '08)*, pp. 16008–16014, July 2008. View at Publisher · View at Google Scholar · View at Scopus - G. Antonelli, F. Arrichiello, and S. Chiaverini, “Experiments of formation control with collisions avoidance using the null-space-based behavioral control,” in
*Proceedings of the 14th Mediterranean Conference on Control and Automation (MED '06)*, pp. 1–6, June 2006. View at Publisher · View at Google Scholar · View at Scopus - J. R. T. Lawton, R. W. Beard, and B. J. Young, “A decentralized approach to formation maneuvers,”
*IEEE Transactions on Robotics and Automation*, vol. 19, no. 6, pp. 933–941, 2003. View at Publisher · View at Google Scholar · View at Scopus - M. A. Lewis and K.-H. Tan, “High precision formation control of mobile robots using virtual structures,”
*Autonomous Robots*, vol. 4, no. 4, pp. 387–403, 1997. 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 Google Scholar · View at Scopus - J. Almeida, C. Silvestre, and A. M. Pascoal, “Cooperative control of multiple surface vessels with discrete-time periodic communications,”
*International Journal of Robust and Nonlinear Control*, vol. 22, no. 4, pp. 398–419, 2012. View at Publisher · View at Google Scholar · View at Zentralblatt MATH · View at MathSciNet - C. Thorvaldsen and R. Skjetne, “Formation control of fully-actuated marine vessels using group agreement protocols,” in
*Proceedings the 50th IEEE Conference on Decision and Control and European Control Conference*, pp. 4132–4139, 2011. - Y. Wang, W. Yan, and J. Li, “Passivity-based formation control of autonomous underwater vehicles,”
*IET Control Theory & Applications*, vol. 6, no. 4, pp. 518–525, 2012. View at Publisher · View at Google Scholar · View at MathSciNet - M. Fu and J. Jiao, “A hybrid approach for coordinated formation control of multiple surface vessels,”
*Mathematical Problems in Engineering*, vol. 2013, Article ID 794284, 8 pages, 2013. View at Publisher · View at Google Scholar · View at MathSciNet - I.-A. F. Ihle, J. Jouffroy, and T. I. Fossen, “Formation control of marine surface craft: a lagrangian approach,”
*IEEE Journal of Oceanic Engineering*, vol. 31, no. 4, pp. 922–934, 2006. View at Publisher · View at Google Scholar · View at Scopus - F. Fahimi, “Non-linear model predictive formation control for groups of autonomous surface vessels,”
*International Journal of Control*, vol. 80, no. 8, pp. 1248–1259, 2007. View at Publisher · View at Google Scholar · View at MathSciNet - J. Almeida, C. Silvestre, and A. Pascoal, “Cooperative control of multiple surface vessels in the presence of ocean currents and parametric model uncertainty,”
*International Journal of Robust and Nonlinear Control*, vol. 20, no. 14, pp. 1549–1565, 2010. View at Publisher · View at Google Scholar · View at Zentralblatt MATH · View at MathSciNet - F. Fahimi, “Sliding-mode formation control for underactuated surface vessels,”
*IEEE Transactions on Robotics*, vol. 23, no. 3, pp. 617–622, 2007. View at Publisher · View at Google Scholar · View at Scopus - S. Yin, S. Ding, and H. Luo, “Real-time implementation of fault tolerant control system with performance optimization,” in
*Proceedings of the IEEE Transactions on Industrial Electronics*, vol. 61, no. 5, 2013. View at Publisher · View at Google Scholar - S. Yin, S. Ding, A. Haghani, H. Hao, and P. Zhang, “A comparison study of basic data-driven fault diagnosis and process monitoring methods on the benchmark Tennessee Eastman process,”
*Journal of Process Control*, vol. 22, no. 9, pp. 1567–1581, 2012. View at Google Scholar - S. Yin, S. X. Ding, A. H. A. Sari, and H. Hao, “Data-driven monitoring for stochastic systems and its application on batch process,”
*International Journal of Systems Science*, vol. 44, no. 7, pp. 1366–1376, 2013. View at Publisher · View at Google Scholar · View at MathSciNet - E. Børhaug, A. Pavlov, E. Panteley, and K. Y. Pettersen, “Straight line path following for formations of underactuated marine surface vessels,”
*IEEE Transactions on Control Systems Technology*, vol. 19, no. 3, pp. 493–506, 2011. View at Publisher · View at Google Scholar · View at Scopus - J. Ghommam and F. Mnif, “Coordinated path-following control for a group of underactuated surface vessels,”
*IEEE Transactions on Industrial Electronics*, vol. 56, no. 10, pp. 3951–3963, 2009. View at Publisher · View at Google Scholar · View at Scopus - X. P. Shi, S. R. Liu, and F. Liu, “New robust control strategy for module manipulators via sliding mode control with an extended state observer,”
*Proceedings of the Institution of Mechanical Engineers I*, vol. 224, no. 5, pp. 545–555, 2010. View at Publisher · View at Google Scholar · View at Scopus - Y. Xia, Z. Zhu, and M. Fu, “Back-stepping sliding mode control for missile systems based on an extended state observer,”
*IET Control Theory & Applications*, vol. 5, no. 1, pp. 93–102, 2011. View at Publisher · View at Google Scholar · View at MathSciNet - S. E. Talole, J. P. Kolhe, and S. B. Phadke, “Extended-state-observer-based control of flexible-joint system with experimental validation,”
*IEEE Transactions on Industrial Electronics*, vol. 57, no. 4, pp. 1411–1419, 2010. View at Publisher · View at Google Scholar · View at Scopus - M. Fu, J. Jiao, and L. Hao, “A coordinated dyanmic positioning control algorithm based on active disturbance rejection control,” in
*Proceedings of IEEE International Joint Conference on Computational Sciences and Optimization*, pp. 67–71, 2012. - B.-Z. Guo and Z.-l. Zhao, “On the convergence of an extended state observer for nonlinear systems with uncertainty,”
*Systems & Control Letters*, vol. 60, no. 6, pp. 420–430, 2011. View at Publisher · View at Google Scholar · View at Zentralblatt MATH · View at MathSciNet - B.-Z. Guo and Z.-L. Zhao, “On convergence of non-linear extended state observer for multi-input multi-output systems with uncertainty,”
*IET Control Theory & Applications*, vol. 6, no. 15, pp. 2375–2386, 2012. View at Publisher · View at Google Scholar · View at MathSciNet - B.-Z. Guo and Z.-L. Zhao, “On convergence of the nonlinear active disturbance rejection control for MIMO systems,”
*SIAM Journal on Control and Optimization*, vol. 51, no. 2, pp. 1727–1757, 2013. View at Publisher · View at Google Scholar · View at Zentralblatt MATH · View at MathSciNet - T. Fossen,
*Marine Control Systems: Guidance, Navigation and Control of Ships, Rigs and Underwater Vehicles*, Marine Cybernetics, Trondheim, Norway, 2002.