Research Article | Open Access
Distributed Synchronization Control to Trajectory Tracking of Multiple Robot Manipulators
This paper investigates the issue of designing decentralized control laws to cooperatively command a team of general fully actuated manipulators. The purpose is to synchronize their movements while tracking a common desired trajectory. Based on the well-known consensus algorithm, the control strategy consists in synchronizing the joint position and the velocity of each robot in the network with respect to neighboring robots' joints and velocities. Modeled by an undirected graph, the cooperative robot network requires just local neighbor-to-neighbor information exchange between manipulators. So, it does not assume the existence of an explicit leader in the team. Based above all on combination of Lyapunov direct method and cross-coupling strategy, the proposed decentralized control law is extended to an adaptive synchronization control taking into account parameter uncertainties. To address the time delay problems in the network communication channels, the suggested synchronization control law robustly synchronizes robots to track a given trajectory. To this end, Krasovskii functional method has been used to deal with the delay-dependent stability problem. A real-time software simulator is developed to visualize the robot manipulators coordination.
There has been a great research effort for synchronization problems, in distributed cooperative control strategies where robot control laws are coupled and each robot control is updated using local rule based on its own sensors and the states of its neighbors [1, 2]. Consensus algorithms, distributed coordination, and passivity-based output synchronization for networked Euler-Lagrange systems have been studied in [3–5], respectively. In this context, one recent representative work  shows that we can synchronize the multicomposed system when only position measurements are available. Synchronization framework that can be directly applied to cooperative control of multiagent systems in robotic manipulation and teleoperation has been presented in . Specifically, the design based on the graph theory and the Laplacian matrix produces interesting results [7–9]. Adaptive control is an effective strategy used to address the synchronization problem [10, 11].
In the literature, most of earlier works on multiagent coordination and consensus [2, 8, 9, 12] mainly deal with very simple dynamic models such as linear systems and focuses on algorithm taking the form of first-order dynamics or second-order dynamics without nonlinear inertia matrices [13–15]. Most previous works on consensus and coordination of multiagent systems using the graph theory and the Laplacian [2, 8, 9, 16, 17] have presented a synchronization to the weighted average of initial conditions but they do not consider multiagent systems where there is a desired path to follow.
The objective of this paper is to develop a synchronized trajectory-tracking control of multiple robot manipulators. The proposed controller relies principally on a consensus algorithm for systems modeled by nonlinear second-order dynamics and applies the algorithm for the synchronization control problem by choosing appropriately information states on which consensus is reached. The concept key of the new synchronizing controller is the introduction of a state vector that quantifies the coordination degree between robot manipulator positions and different positions of its neighbors, using cross-coupling technique. Robot manipulators are widely used in production processes. In tasks that can not be fulfilled by a single robot, either because of the complexity of the task or the spatial and temporal limits of the robot, the use of cooperative robots proved to be a good determination . The tasks being executed by each robot may terminate in different time due to nonhomogenity of robots or even electronics that drives motors of robots’ joints. Despite the common trajectory robots have to track, it is not almost sure that the final running time of each robot will definitely be the same. So, in order to ensure this same final running time, robots have to have image of the current state of the neighboring robots as such to synchronize their movement together.
This paper presents a distributed control strategy. Through local interactions, the proposed approach can achieve more efficient performances, in particular in the presence of external disturbances. The proposed method based on a combination of Lyapunov direct method and concepts of cross-coupling, through a convenient mathematical manipulation, has converted the motion control problem of multiple systems into a stabilization problem for one single system. Compared to existing approaches, main contributions of this paper can be stated as follows. (1)The present work deals with highly nonlinear systems. While [13–15], to name a few, deal with simple dynamic models. (2)In contrast to [2, 8, 9, 16, 17] the proposed approach achieves not only global asymptotical synchronization of the configuration variables, but also global asymptotical convergence to the desired trajectory. (3)The theory is extended to adaptive control and time delay control. (4)In [10, 11, 19], the position synchronization error of each robot is defined as the differential position error between this robot and its two adjacent robots. However, the proposed design allows interconnections between all robots, such that all robots have direct influence in the combined dynamics, and consequently the synchronous behavior is the result of interactions between all robots. Moreover, it is straightforward to show that the particular choice of the tracking error surface in the proposed approach provides an exponential convergence of to if we have a constant tracking error surface. (5)Using the Virtual Reality Modeling Language (VRML) a virtual world was developed to simulate the robot synchronization application in 3D scenes.
The dynamic equation of a general rigid link manipulator having degrees of freedom in a free space can be written as where denotes the th robot index in the network and is the total number of the individual elements. In addition, denotes the vector of generalized displacements of the th robot coordinates, and denotes the vector of generalized control input torques in robot coordinates; inertia matrix which is symmetric uniformly bounded and positive definite, is a vector function containing Coriolis and centrifugal forces, and is a vector function consisting of gravitational forces. According to [20, 21], we have some fundamental properties of motion equations.
(i) The inertia matrix is symmetric, positive definite, and uniformly bounded:
(ii) Using a proper definition, is a skew symmetric matrix, satisfying where is the transpose of a vector .
(iii) The Euler-Lagrange equation (1) is linear with respect to the structural parameter , hence, where is the regressor matrix composed of known functions of , and , is the vector of structural parameters of the manipulator, and is the number of unknown parameters. In the present topology, the edge represents bidirectional communication links. This consists of a group of manipulators interchanging information that can be viewed as an undirected graph (Figure 1).
3. Controller Design
We design decentralized control laws for robot manipulators such that all joint positions mutually synchronize and track a common desired trajectory. The control objective of the proposed synchronization controller scheme is to synchronize the th-joint position and velocity , to the state of any manipulator , . Besides the controller is required to regulate the joint position to track a desired trajectory . Specifically, the control torque for the th-robot is to control the tracking error to converge to zero and at the same time to synchronize its motion with respect to motions of the robots in the network, so that the synchronization error converges to zero. To this end, we define the tracking error surface of the th manipulator as where is a diagonal positive-definite matrix. Information on the vector will give insight on the convergence of the joint positions to the desired trajectory. However, it is straightforward to show that this particular choice of this tracking error surface provides an exponential convergence of to if we have a constant tracking error surface. But the defined sliding error only guarantees the trajectory tracking. Nevertheless, it is required to know the performance of the controller, that is, to know how the trajectory of each robot manipulator converges with respect to each other. There are various ways to choose the synchronization error. For example in , authors include the error information of all systems involved in the synchronization. In , authors use the cross-coupling concept to solve the synchronization problem. Our approach will make use of the cross-coupling to propose a feasible and efficient synchronization error, which consists on a measure of the synchronization for robot manipulators as defined as follows: where is a symmetric positive-definite matrix that gives insight on the communication quality between the th and th robot manipulators. We note that if and only if there is information exchange between robot manipulators and . Consequently, each robot is not necessarily aware of all other robots. Therefore, we define the synchronizing tracking error surface which encompasses both synchronization error and trajectory tracking error for manipulator as: The objective is to design a control law such that coupling errors, that is, position errors, velocity errors, and synchronization errors, all converge to zero. For each manipulator, the control law is defined as follows: where is a common trajectory reference to be tracked, which is a smooth time-varying trajectory and for which the first and the second derivative exist for all . and are symmetric positive-definite matrices.
Theorem 1. If , the proposed synchronization tracking controller (8) guarantees asymptotic convergence to zero of position errors, velocity errors, and synchronization errors, that is, as .
Remark 1. Note that the synchronization controller only requires local information of the joint position , the joint velocity and the information about the desired trajectory. Also in order to ensure synchronization with other robots it needs information on the joint position from neighbors. It has to be noticed that the joint position of the neighboring robots are lumped into the error variable .
Proof. Notice that the controller law (8) contains PD controller terms. However, these terms are premultiplied by the inertia matrix . Therefore it is clear that this is not a linear controller as the PD control law, since the position and velocity gains are not constant but they depend explicitly on the position error.
Substituting (8) in (1) yields: Multiplying by in both sides yields Adding in both sides yields This results in Using the expression of the synchronization error and its first derivative gives Further calculation will result in Equation (14) represents the closed-loop synchronized system for the th manipulator. In the sequel, we proceed to analyze the stability properties of the proposed synchronized control scheme and ultimately show that the control goals: the position error, velocity error, and synchronization error, all converge to zero. To prove stability of the overall synchronized system, we define .
Using (14) we obtain the synchronized error dynamics: where , and is given by Note that is symmetric and positive semidefinite matrix.
The synchronized error dynamics (15) is a linear time invariant system described by a second-order linear differential equation. A sufficient condition for the error dynamics to be exponentially stable is that the matrices and are positive definite. In particular, matrices can be diagonal satisfying .
To analyze the stability properties of the closed-loop error dynamics (15), we take the following definite and radially unbounded Lyapunov function candidate: Its derivative with respect to time can be expressed as It follows by direct application of LaSalle's invariance principle that the origin is globally asymptotically stable and for .
Referring to the expression of the global error (7) as we have We set . Then (20) can be written as Our objective is to show that converges to zero as . To this end, we define and . Equation (21) can be written as where matrix is given by Consider the following Lyapunov function: Differentiating with respect to time yields Knowing that consequently, It follows by direct application of LaSalle's invariance that the origin is globally asymptotically stable. Consequently we obtain for . Then and for .
Referring to (19), we show that for .
4. Adaptive Synchronization
In this section, we consider an uncertainty in the model parameters. We propose to extend the previous decentralized control law to an adaptive version. For that, we consider the following adaptive control law, which has the similar local coupling structure as the proposed control law in (8): We recall that a similar relation to (1) holds when the estimate parameter vector is used to replace the exact parameter vector : where is the vector of structural parameters of the manipulator and is the number of unknown parameters. The estimated parameter is subject to the adaptation law: where is a diagonal positive-definite matrix. Since the value of the dynamic parameter is hard to be known exactly in practice, one defines as the estimate of . , , and are estimates of , , and , respectively. denotes a regression matrix. Define as a vector containing model estimation errors. Then the adaptation law (30) can be written as
Proof. Substituting (28) into the dynamic model (1) leads to the following closed-loop dynamics:
Taking into account (33), (32) gives:
Using (29), the dynamic (34) is written as
To prove the stability of the overall synchronized system, we define , , , , .
Writing (36) in a compact form gives the following: Multiplying by both sides yields Define the Lyapunov function candidate as Differentiating with respect to time yields Substituting (38) into (40) consequently Using the adaptation law (31) gives Since , we have , and this yields that , which gives that , and are bounded.
Differentiating with respect to time yields Using Barbalat's lemma, is bounded because , , and are bounded. This implies for and hence for . The proof pursued the same line reasoning as the proof of Section 3. Consequently, we show that position errors, velocity errors and synchronization errors, converge asymptotically to zero.
5. Synchronization with Time Delays
In this section, we study the coordination control problem taking into account time delays of communication channels. As a first assumption, we suppose that these delays can be justified by the fact that data information sent by the neighboring vehicles reaches vehicle after a certain time delay due to the short-range communication channels. To take into account time delays produced during the communication among robots, we introduce, in the coordination error expression, a term which represents the same time delay due to the short-range communication channels. Therefore, a coordination error, in the time delay context, will be presented as the well-known classical time delay model of multiagent network : It will be shown that the behavior of the coordinated system under the effect of time delay changes significantly. Consequently, the controller implanted in each lagrangian system among the network takes the following expression.
Theorem 3. Implemented controller taking the following expressions : stabilize the behavior of the robot network.
Proof. Substituting (46) into (1) yields
By further calculation, we obtain the synchronized error dynamics:
where , , and are the same matrices already defined (see Section 3). By the Leibnitz formula, we have
Substituting (49) into (48) leads to
Setting . Therefore (50) can be written as
This yields the following form:
with and .
To analyze the stability of the global system, we consider the following Lyapunov-Krasovskii functional (LKF): where , , are weighting matrices of appropriate dimensions. A straightforward computation gives the time derivative of along the solution of (53) as where , , , . The Jensen's inequality gives a suitable bound for the last term of (54): with . Thus, the time derivative of the LKF (53) can be bounded by , where Then if the LMI is satisfied, the derivative of the Lyapunov-Krasovskii functional is negative definite. To ensure matrix is negative definite, we select appropriate control gains and throught processing MATLAB's LMI solver such that Then, if the LMI is satisfied, the derivative of the Lyapunov-Krasovskii functional is therefore negative definite. In consequence, the origin is asymptotically stable.
This results in for and for . The proof for the asymptotic convergence of the coordinated tracking error is not sufficient to prove the convergence to zero of both errors and . Now, our concern is is to show that coordination is successfully realized for a specific time delay .
The proof pursued the same line reasoning as the proof of Section 3. Consequently, we obtain the following equation derived from the global error expression: Rewriting all states of (58) into a compact representation and applying the Laplace transform lead to This can be written as If the characteristic equation = has all its zeros in the left half complex plan, then the system is stable and one can easily conclude about the convergence of to . Since the ordinal system, free from time delay (i.e, ), is a continuous function of , then using the D-decomposition, the minimal positive solution to the following equation: which would make all the zeros of the characteristic equation in the left half complex plane. Therefore if we select , where , therefore solutions of (60) converge to zero and consequently , , and for .
6. Simulation Results
To show the effectiveness of the proposed synchronizing controller, we run two types of simulation.
Simulations are performed on MATLAB/Simulink. These simulations were performed on identical three manipulators with two degrees of freedom. Robots do not have the same starting positions, and they start their motion at . First, we assume that no parameter uncertainty is present and that the transmission delay can be neglected. Figure 2 illustrates the robots synchronization tracking a common trajectory. This proves that tracking and synchronization objectives are attained by the proposed controller which explains how robots, while tracking the desired trajectory, synchronize their position with others. Next, we assume that the length and the mass of manipulators are unknown. Consequently, mass, Coriolis, and gravity matrices are ill known. Figure 3 plots an adaptive position tracking while in Figures 4 and 5 tracking errors and synchronizing errors are shown, respectively. Finally, we consider the time delay in communication. Figures 6 and 7 illustrate that the behavior of the coordinated system changes significantly, under the effect of time delays in communication channels. The speed for achieving an agreement depends essentially on the time delay of communication channels.
One effective solution is to develop a platform to simulate the complex system design before hardware implementation. To design this virtual environment, we apply several tools, such as the modeling package Cinema 4D, MATLAB VRML (Virtual Reality Modeling Language) toolbox, and MATLAB/Simulink. Robot CAD (Concept Architecture Design) models created using 4D cinema are extracted in VRML97 (.wrl) format. The VRML file is edited by V-Realm Builder 2.0 before being imported into MATLAB-Simulink by the VR (Virtual Reality) Toolbox. A VRML file uses a standard text format which can be read with any text editor. For MATLAB, the Virtual Reality Toolbox software includes the Ligos V-Realm Builder application as a native 3D editor. But the 3D editing tools remain the most efficient. In fact, the CAD packages offer the power and versatility to create many types of practical models and techniques. In the developed real-time software simulator we used the 4D Cinema as CAD package where the robots are designed. Next, the 3D objects are imported. Simulink model generates signal data which is used to control and animate the virtual world. Reality Toolbox block is added to the Simulink model in order to ensure communication with the virtual world. The 3D virtual reality environment is presented in Figure 8.
This paper has considered the synchronization problem in distributed Multirobot systems under cooperative schemes. The aim of this work is to find out a decentralized controller, applied to each manipulator; the synchronization is therefore met. It has been shown that the proposed strategy can coordinate manipulator articulations to track a given time-varying trajectory. As an extension, we moved to the step which entails the fact that mass, Coriolis, and gravity matrices are badly known. In this case, the proposed controller has encompassed an adaptive version. The obtained simulation results from Multirobot motion control system demonstrate the effectiveness of the synchronization approach. To deal with time delays problem in communication between robots, the proposed decentralized control guarantees that information variables of each robot reach agreement even in the presence of communication channels delays. A new package for simulation of coordinated robot manipulators is developed. Simulations which have been applied to an illustrative example have shown the effectiveness of the described strategy.
- S.-J. Chung and J.-J. E. Slotine, “Cooperative robot control and concurrent synchronization of lagrangian systems,” IEEE Transactions on Robotics, vol. 25, no. 3, pp. 686–700, 2009.
- A. Jadbabaie, J. Lin, and A. S. Morse, “Coordination of groups of mobile autonomous agents using nearest neighbor rules,” IEEE Transactions on Automatic Control, vol. 48, no. 6, pp. 988–1001, 2003.
- W. Ren, “Distributed leaderless consensus algorithms for networked Euler-Lagrange systems,” International Journal of Control, vol. 82, no. 11, pp. 2137–2149, 2009.
- J. Mei, W. Ren, and G. Ma, “Distributed coordinated tracking with a dynamic leader for multiple euler-lagrange systems,” IEEE Transactions on Automatic Control, vol. 56, no. 6, pp. 1415–1421, 2011.
- H. Yu and P. J. Antsaklis, “Passivity-based output synchronization of networked Euler-Lagrange systems subject to nonholonomic constraints,” in Proceedings of the American Control Conference (ACC '10), pp. 208–213, 2010.
- A. Rodriguez-Angeles and H. Nijmeijer, “Mutual synchronization of robots via estimated state feedback: a cooperative approach,” IEEE Transactions on Control Systems Technology, vol. 12, no. 4, pp. 542–554, 2004.
- Y.-C. Liu and N. Chopra, “Synchronization of networked robotic systems on strongly connected graphs,” in Proceedings of the 49th IEEE Conference on Decision and Control (CDC '10), pp. 3194–3199, 2010.
- Z. Lin, M. Broucke, and B. Francis, “Local control strategies for groups of mobile autonomous agents,” IEEE Transactions on Automatic Control, vol. 49, no. 4, pp. 622–629, 2004.
- R. Reza Olfati-Saber and R. M. Murray, “Consensus poblems in networks of agents with switching topology and time-delays,” IEEE Transactions on Automatic Control on Networked Control Systems, vol. 49, no. 9, 2004.
- D. Sun, “Position synchronization of multiple motion axes with adaptive coupling control,” Automatica, vol. 39, no. 6, pp. 997–1005, 2003.
- D. Sun and J. K. Mills, “Adaptive synchronized control for coordination of multirobot assembly tasks,” IEEE Transactions on Robotics and Automation, vol. 18, no. 4, pp. 498–510, 2002.
- Z. Qu, J. Wang, and R. A. Hull, “Cooperative control of dynamical systems with application to autonomous vehicles,” IEEE Transactions on Automatic Control, vol. 53, no. 4, pp. 894–911, 2008.
- J. R. Lawton and R. W. Beard, “Synchronized multiple spacecraft rotations,” Automatica, vol. 38, no. 8, pp. 1359–1364, 2002.
- R. Olfati-Saber, J. A. Fax, and R. M. Murray, “Consensus and cooperation in networked multi-agent systems,” Proceedings of the IEEE, vol. 95, no. 1, pp. 215–233, 2007.
- W. Ren and R. W. Beard, “Consensus seeking in multiagent systems under dynamically changing interaction topologies,” IEEE Transactions on Automatic Control, vol. 50, no. 5, pp. 655–661, 2005.
- W. Ren, “Multi-vehicle consensus with a time-varying reference state,” Systems and Control Letters, vol. 56, no. 7-8, pp. 474–483, 2007.
- W. Ren, R. W. Beard, and E. Atkins, “Information consensus in multivehicle cooperative control: collective group behavior through local interaction,” IEEE Control Systems Magazine, vol. 27, no. 2, pp. 71–82, 2007.
- B. Yassine , G. Jawhar, and G. Poisson, “Adaptive multi-robots synchronization,” in Proceedings of the IEEE International Symposium on Industrial Electronics (ISIE '10), pp. 1797–1802, Bary, Italy, jully 2010.
- D. Sun, X. Shao, and G. Feng, “A model-free cross-coupled control for position synchronization of multi-axis motions: theory and experiments,” IEEE Transactions on Control Systems Technology, vol. 15, no. 2, pp. 306–314, 2007.
- J. J. Craig, P. Hsu, and S. S. Sastry, “Adaptive control of mechanical manipulators,” in Proceedings of the IEEE International Conference on Robotics and Automation, pp. 190–195, San Francisco, Calif, USA.
- J. J. E. Slotine and W. Li, “Adaptive manipulator control: a case study,” IEEE Transactions on Automatic Control, vol. 33, no. 11, pp. 995–1003, 1988.
Copyright © 2011 Yassine Bouteraa 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.