Research Article  Open Access
Dual NumberBased Relative Position and Attitude Coordinated Control for MultiRigidBody System
Abstract
The paper focuses on finding a dual number solution to position and attitude coordinated control for a multirigidbody system. First, a relative motion coupling model of a multirigidbody system is established under the framework of dual number and dual quaternion theory. Then, a coordinated control strategy that uses graph theory based on a derived new type of dual quaternion is proposed to simultaneously control the position and attitude of a multirigidbody system. Finally, the resulting Lyapunov function is proved to be almost globally asymptotically stable. The simulation results show that the proposed algorithm not only achieves unified control of position and attitude but also exhibits better tracking control performance.
1. Introduction
Multiagent systems have become an important topic of research in recent years, with an increasing number of scholars researching them. The object of this research is a set of selfgoverning agent groups in which multiple agents exchange information such as goals, strategies, and plans. Compared with a single subsystem, a multiagent system is more robust. A multibody system is a special type of multiagent system that not only has the advantages of a multiagent system but is also widely used in the fields of unmanned aerial vehicle (UAV) cooperation tracking, satellite formation flights, intelligent transportation, distributed sensor networks, and swarm robot systems, which are all of increasing interest to researchers. Formation control, as an important research direction of the coordinated control of multirigidbody systems, has become a pressing issue in the field of control research in recent years [1–17]. For example, regarding the research of networks [1–4], the authors of [1] investigated the controllability issues of multiagent networks and then proposed a new perspective to graphical characterization of multiagent controllability [2]; the author of [3] investigated the bipartite consensus problem for multiagent systems with secondorder dynamics and antagonistic interactions; and in [4], the output feedback control and stabilization of multiplicative noise systems with intermittent observations were proposed. Regarding the research of spacecraft formation [5–10], the authors of [6] proposed a decentralized coordinated attitude control law for satellite formation flying, while the authors of [8] proposed a relative orbit estimation and formation to maintain control of satellite formations in low Earth orbits; and in [9], the authors considered a distributed attitude alignment problem for a team of deepspace formation flying spacecraft with the assistance of local information exchanges. Regarding the research of unmanned aerial vehicle formations [11, 12], the authors of [11] proposed a distributed output feedback formation tracking control law for UAVs, and in [12], a distributed UAV formation control method using a differential game approach was proposed. In research on multirobot formation [13, 14], the authors of [13] designed and implemented a novel decentralized control scheme that achieves dynamic formation control and collision avoidance for a group of nonholonomic robots, and in [14], a novel cooperative coevolutionary algorithm was proposed. However, the abovementioned algorithms consider relative motion control of the position and attitude of a multirigidbody formation as two separate subsystems. As an alternative solution, some scholars have proposed an integrated coupling of position and attitude dynamic models and control methods [15–17]. For example, the authors of [15] proposed a sixdegreeoffreedom spacecraft formation control method with possible switching topology. By rearranging the combined translational and rotational dynamics into a unified EulerLagrange formulation, the developed controllers can be applied directly to maintain formation and desired relative attitudes. The authors of [16] established a sixdegreeoffreedom model of the satellite’s orbit and attitude coupling based on masterslave structure and constructed an output feedback control strategy without measuring the angular velocity. Although this algorithm treats the characteristics of position and attitude as if they were coupled, it is still based on separate descriptions of position and attitude, and thus, two sets of control laws still need to be designed, thereby increasing the computational complexity.
As a basic problem of the coordinated control of a multiagent system, the problem of consistency had been a matter of concern for an increasing number of researchers [18–24]. In [18], the leaderfollowing consensus problem of higherorder multiagent systems is considered; in [19], a networkbased consensus control protocol under a directed graph is proposed; and in [20], a robust adaptive control approach for solving the consensus problem of multiagent systems is proposed. A multirigidbody system is a special type of multiagent system, and formation control is an important problem that is closely related to the problem of consistency in the coordinated control of multirigidbody systems. At present, in the context of the coordinated control of a multirigidbody formation, most scholars still do not consider the problem of information interaction between rigid bodies and thus cannot coordinate rigid body formation.
To offer a solution for the outlined problems, this paper proposes a distributed coordinated control algorithm of multirigidbody systems based on dual number theory and graph theory. The rest of the paper is organized as follows. Section 2 introduces the concepts of dual number and dual vector along with graph theory. Then, the relative dynamics models for a multirigidbody within the dual quaternion theory framework are derived. In the next section, according to the quaternion logarithm operation and the dual quaternion Lie group properties, we define a new dual quaternion, , and on the basis of the new dual quaternion, a coordinated control law is deduced. Then, the control law is proved to be almost globally asymptotically stable. Finally, a numerical example is used to verify the effectiveness of the proposed control law.
2. Related Concepts
2.1. Dual Number
The concept of dual number was first proposed by Clifford as follows [25]:where is the real part of the dual number, is the dual part, and is the dual unit, which satisfies .
A dual vector is a special type of dual number that has real and dual parts that are vectors. For example, the dual vector , which is composed of the force acting on a rigid body and the produced torque relative to point O, is
While the torque acting on a rigid body depends on the choice of a reference point, the force does not depend on a reference point.
If the angular velocity of a rigid body at a certain time is , and the velocity at a point is , then the dual vector can be expressed as follows:
A dual quaternion can be described as a dual number whose real and dual parts are both unit quaternions, as defined by
In (4), the real part and the dual part are both quaternion; the real part describes the rotation of the rigid body, and the dual part describes its translation.
Quaternions and dual quaternions have similar properties:
From the basic properties of the dual quaternions, the following conclusion can be drawn:
If , then the dual quaternion is called a unit dual quaternion.
2.2. Graph Theory
Multirigidbody systems are essentially a class of multiagent systems, and each rigidbody is considered an individual component in a multiagent system. Each individual component acquires its own control laws through interaction with its neighbours and thereby realizes overall control. In this paper, the topology of the multirigidbody system is modelled by graph theory.
Directed and undirected graphs are the most suitable mathematical objects for modelling the information topology of communications and perceptions between multiple rigid bodies. The directed graph is denoted by and consists of a set of nonempty nodes representing the rigid bodies and a set of edges representing the relationships between communications and perceptions. When , the matrix has full rank. The adjacency matrix of graph is defined as , and the weights satisfy when and otherwise. In an undirected graph, .
The interaction between individual agents is realized through the following protocol [26]:where the indices i and j specify a given rigid body in the topological network.
3. MultiRigidBody System Relative Kinematics and Dynamics Model
The rigidbody kinematics are given bywhere n is the total number of rigid bodies in the team.
The relative kinematics equation of the multirigidbody system, written in terms of dual numbers, iswhere and represent the ith and jth rigid body, respectively, and is the dual quaternion of the ith rigid body relative to the jth rigid body. From , one can calculate the relative position and attitude between two rigid bodies. is the attitude quaternion of the ith rigid body relative to the jth rigid body, and . is the absolute value of the relative position vector in the ith rigid body frame.
Theorem 1. For the ith and jth rigid bodies, the relative dynamics equation can be derived as , where is the dual inertia matrix of the jth rigid body, and is the dual force acting on the jth rigid body.
Proof. The dual velocity can be written aswhere is the dual velocity of the ith rigid body relative to the jth rigid body, is expressed in iframe coordinates, and is expressed in jframe coordinates; they are dual velocities relative to the inertial frame. is the conjugate of .
After taking the derivatives of formula (10) variables, we obtain formula (11): The position and attitude coupling dynamic model of the ith and jth rigid body in the inertial frame arewhere the dual matrix of the inertia of the rigid body is given in [27]In this formula, is the mass of the follower rigid body, is the thirdorder unit matrix, and is the rotational inertia of the follower rigid body. The inverse of dual inertia matrix is defined as follows:The following expression can be obtained from formula (12):Substituting formula (15) into formula (11), we can obtain formula (16):Formula (16) is the relative dynamics equation.
Hence, we complete the proof.
4. Design of the Coordinated Control Law
4.1. Design of a New Dual Quaternion
According to the Euler theorem, the attitude of one coordinate system relative to the other can be obtained by rotating the angle around the unit axis ; then, the unit quaternion can be expressed as
Lemma 2. The logarithmic mapping of a unit dual quaternion can be written as
Proof. Using the quaternion logarithm and the dual quaternion Lie group properties [28], we arrive at the following formula:When is small,The real and dual parts of the logarithmic dual quaternion correspond exactly to position and attitude. Therefore, we define a new dual quaternion as follows:Hence, we complete the proof.
4.2. Design of the Control Law
The design of a multirigidbody system coordination control law mainly solves the pose coordination problem. As long as all state variables are bounded, it is ensured that each rigid body tracks the desired pose. Suppose that two rigid bodies are represented by and ; then, when ,where is the expected value of the rigid body’s relative position and attitude.
Theorem 3. For the relative motion coupling model based on the dual quaternion (9) and (16), the control law is written as follows:
Proof. The ideal position and attitude coordinated control law is designed as follows:where is called the absolute pose tracking item and is used to track the overall desired position and attitude of the multirigidbody system; is called the relative pose preservation item and is used to adjust the pose of the current rigid body (according to the pose of the adjacent rigid body) to ensure that the relative position and altitude of the multirigidbody remain consistent. According to the graph theory, the expressions for and arewhere , and and are positive constants. From formula (5), we obtain . is the ith row and jth column element of the weighted adjacency matrix associated with the graph for the relative pose .
4.3. Stability Analysis
We present the stability conclusions of the proposed multirigidbody system coordinated control algorithm in the form of a theorem.
Theorem 4. Assume that the control law is given by formula (23) and the undirected communication graph is connected; then, the multirigidbody system can achieve pose tracking and effective pose coordination. When , then , , and asymptotically, .
Proof. Consider a Lyapunov function candidate:Since is a positive definite matrix, the Lyapunov function satisfies if and only if ; if , then the Lyapunov function is positive and definite.
Lemma 5. If , then , where .
Proof. SupposeThenThenSubstituting into formula (29), we obtain the following formula:Hence, we complete the proof.
Similarly, by taking the derivative of formula (27), we can arrive atwhereThen, formula (32) can be further simplified:Substituting the value of into formula (34), we obtainTo make , there must be a case where , and when , we can obtain the following formula:Formula (36) can be written in two parts:According to [9], formula (37) can be written aswhere is the Kronecker product, is the identity matrix, is a column vector stack composed of , and , where and . Since , we see that is strictly diagonally dominant, and the matrix has full rank. It can be seen that . By LaSalle’s invariance principle, we arrive at the conclusion that when , the condition is satisfied. Therefore, when , the following holds: , asymptotically. Equivalently, we know that . Similarly, using formula (38), we can conclude that when , .
Hence, we complete the proof.
5. Simulation and Discussion
Using the presented theoretical analysis, we apply the proposed algorithm to the coordinated control of formation rigid bodies. Taking the posecoordinated control of six rigid bodies as an example, we verify the effectiveness of the control law. Each rigid body is regarded as a node, and the undirected graph is used to model the information flow between the rigid bodies. The interactions between the rigid bodies are shown in Figure 1.
The initial attitude and position of the rigid bodies are listed in Table 1. The initial dual angular velocities of the rigid bodies are , and the desired attitude and position are and , respectively. , and the simulation time is .

Figures 2 and 3 are attitude and angular velocity tracking curves, respectively, and Figures 4 and 5 are position and velocity tracking curves, respectively. The attitude and angular velocity tracking curves of Figures 2 and 3 show that the attitude and angular velocity of rigid bodies 1, 3, and 5 converge to zero within 40 seconds, thereby completing the attitude tracking. The position and velocity tracking curves of Figures 4 and 5 show that the convergence time of the position tracking curve is slower than that of the attitude tracking curve, and it converges to 0 in approximately 300 seconds. Thus, both the attitude and position tracking errors converge rapidly in a short period of time and satisfy the accuracy requirements. The multirigidbody system basically realizes attitude and position tracking.
To further demonstrate the effectiveness of the algorithm, we simulate the attitude, angular velocity, position, and velocity of each rigid body. The simulation results are shown in Figures 6, 7, 8 and 9.
Figures 6 and 7 are attitude and angular velocity tracking curves of rigid bodies 1, 3, and 5, respectively, and Figures 8 and 9 are position and velocity tracking curves of rigid bodies 1, 3, and 5, respectively. These figures show that both the attitude and position errors of every rigid body converge rapidly and satisfy the accuracy requirements despite the presence of the initial errors. Therefore, it is feasible to carry out position and attitude coordinated control of a multirigidbody system on the basis of dual number and dual quaternion. The simulation results show that the algorithm not only achieves unified control of relative position and attitude but also exhibits good tracking control performance.
6. Conclusions
A new type of dual quaternion is investigated in this study. From the derived form of dual quaternion together with graph theory, we proposed a novel coordinated control law to simultaneously control position and attitude. Then, the Lyapunov function is used to prove that the model is almost globally asymptotically stable in terms of the control law. The simulation results indicate that the controller that considers the coupling effect performs better than the traditional controller that considers the relative position and attitude separately. Additionally, the proposed algorithm in this paper is simpler and can simultaneously control both relative position and attitude.
Data Availability
The data used to support the findings of this study are included within the article.
Conflicts of Interest
The author declares no conflicts of interest.
Acknowledgments
This work was supported by the Supporting Fund for Teachers’ Research of Jining Medical University (No. JY2017KJ052).
References
 Z. Ji, H. Lin, and H. Yu, “Protocols design and uncontrollable topologies construction for multiagent networks,” IEEE Transactions on Automatic Control, vol. 60, no. 3, pp. 781–786, 2015. View at: Publisher Site  Google Scholar  MathSciNet
 Z. Ji and H. Yu, “A new perspective to graphical characterization of multiagent controllability,” IEEE Transactions on Cybernetics, vol. 47, no. 6, pp. 1471–1483, 2017. View at: Publisher Site  Google Scholar
 L. Tian, Z. Ji, T. Hou, and K. Liu, “Bipartite consensus on coopetition networks with timevarying delays,” IEEE Access, vol. 6, pp. 10169–10178, 2018. View at: Publisher Site  Google Scholar
 Q. Qi and H. Zhang, “Output feedback control and stabilization for multiplicative noise systems with intermittent observations,” IEEE Transactions on Cybernetics, 2017. View at: Google Scholar
 P. P. Menon, C. Edwards, and N. M. Gomes Paulino, “Observerbased controller design with disturbance feedforward framework for formation control of satellites,” IET Control Theory & Applications, vol. 9, no. 8, pp. 1285–1293, 2015. View at: Publisher Site  Google Scholar  MathSciNet
 I. Chang, S.Y. Park, and K.H. Choi, “Decentralized coordinated attitude control for satellite formation flying via the statedependent Riccati equation technique,” International Journal of NonLinear Mechanics, vol. 44, no. 8, pp. 891–904, 2009. View at: Publisher Site  Google Scholar
 Y. Wu, X. Cao, P. Zhang, and Z. Zeng, “Variable structurebased decentralized relative attitudecoordinated control for satellite formation,” IEEE Aerospace & Electronic Systems Magazine, vol. 27, no. 12, pp. 18–25, 2012. View at: Google Scholar
 G. Zeng, M. Ru, and R. Yao, “Relative orbit estimation and formation keeping control of satellite formations in low Earth orbits,” Acta Astronautica, vol. 76, pp. 164–175, 2012. View at: Publisher Site  Google Scholar
 W. Ren, “Distributed attitude alignment in spacecraft formation flying,” International Journal of Adaptive Control and Signal Processing, vol. 21, no. 23, pp. 95–113, 2007. View at: Publisher Site  Google Scholar  MathSciNet
 H. Yang, X. You, and C. Hua, “Attitude tracking control for spacecraft formation with timevarying delays and switching topology,” Acta Astronautica, vol. 126, pp. 98–108, 2016. View at: Publisher Site  Google Scholar
 L. He, X. Sun, and Y. Lin, “Distributed outputfeedback formation tracking control for unmanned aerial vehicles,” International Journal of Systems Science, vol. 47, no. 16, pp. 3919–3928, 2016. View at: Publisher Site  Google Scholar  MathSciNet
 W. Lin, “Distributed UAV formation control using differential game approach,” Aerospace Science and Technology, vol. 35, no. 1, pp. 54–62, 2014. View at: Publisher Site  Google Scholar
 S. Mastellone, D. M. Stipanović, C. R. Graunke, K. A. Intlekofer, and M. W. Spong, “Formation control and collision avoidance for multiagent nonholonomic systems: Theory and experiments,” International Journal of Robotics Research, vol. 27, no. 1, pp. 107–126, 2008. View at: Publisher Site  Google Scholar
 S.M. Lee, H. Kim, H. Myung, and X. Yao, “Cooperative coevolutionary algorithmbased model predictive control guaranteeing stability of multirobot formation,” IEEE Transactions on Control Systems Technology, vol. 23, no. 1, pp. 37–51, 2015. View at: Publisher Site  Google Scholar
 H. Min, S. Wang, F. Sun, Z. Gao, and Y. Wang, “Distributed six degreeoffreedom spacecraft formation control with possible switching topology,” IET Control Theory & Applications, vol. 5, no. 9, pp. 1120–1130, 2011. View at: Publisher Site  Google Scholar  MathSciNet
 J. Shan, “Synchronized attitude and translational motion control for spacecraft formation flying,” Proceedings of the Institution of Mechanical Engineers, Part G: Journal of Aerospace Engineering, vol. 223, no. 6, pp. 749–768, 2009. View at: Publisher Site  Google Scholar
 S. Segal and P. Gurfil, “Effect of kinematic rotationtranslation coupling on relative spacecraft translational dynamics,” Journal of Guidance, Control, and Dynamics, vol. 32, no. 3, pp. 1045–1050, 2009. View at: Publisher Site  Google Scholar
 H. Hermansyah, A. Wijanarko, M. Kubo, N. ShibasakiKitakawa, and T. Yonemoto, “Leaderfollowing consensus of multiagent systems under fixed and switching topologies,” Systems & Control Letters, vol. 59, no. 34, pp. 209–217, 2010. View at: Google Scholar
 L. Ding, Q.L. Han, and G. Guo, “Networkbased leaderfollowing consensus for distributed multiagent systems,” Automatica, vol. 49, no. 7, pp. 2281–2286, 2013. View at: Publisher Site  Google Scholar  MathSciNet
 Z. G. Hou, L. Cheng, and M. Tan, “Decentralized robust adaptive control for the multiagent system consensus problem using neural networks,” IEEE Transactions on Systems, Man, and Cybernetics, Part B: Cybernetics, vol. 39, no. 3, pp. 636–647, 2009. View at: Publisher Site  Google Scholar
 H. Geng, Z.Q. Chen, Z.X. Liu, and Q. Zhang, “Consensus of a heterogeneous multiagent system with input saturation,” Neurocomputing, vol. 166, pp. 382–388, 2015. View at: Publisher Site  Google Scholar
 J. Bai, G. Wen, A. Rahmani, X. Chu, and Y. Yu, “Consensus with a reference state for fractionalorder multiagent systems,” International Journal of Systems Science, vol. 47, no. 1, pp. 222–234, 2016. View at: Publisher Site  Google Scholar  MathSciNet
 Y. Zheng, Y. Zhu, and L. Wang, “Consensus of heterogeneous multiagent systems,” IET Control Theory & Applications, vol. 5, no. 16, pp. 1881–1888, 2011. View at: Publisher Site  Google Scholar  MathSciNet
 G.S. Han, Z.H. Guan, J. Li, D.X. He, and D.F. Zheng, “Multitracking of secondorder multiagent systems using impulsive control,” Nonlinear Dynamics, vol. 84, no. 3, pp. 1771–1781, 2016. View at: Publisher Site  Google Scholar  MathSciNet
 P. Clifford, “Preliminary Sketch of Biquaternions,” Proceedings of the London Mathematical Society, vol. 4, pp. 381–395, 1871/73. View at: Publisher Site  Google Scholar  MathSciNet
 Z. Ji, H. Lin, and H. Yu, “Leaders in multiagent controllability under consensus algorithm and tree topology,” Systems & Control Letters, vol. 61, no. 9, pp. 918–925, 2012. View at: Publisher Site  Google Scholar
 V. Brodsky and M. Shoham, “Dual numbers representation of rigid body dynamics,” Mechanism and Machine Theory, vol. 34, no. 5, pp. 693–718, 1999. View at: Publisher Site  Google Scholar
 X. Wang, D. Han, C. Yu, and Z. Zheng, “The geometric structure of unit dual quaternion with application in kinematic control,” Journal of Mathematical Analysis and Applications, vol. 389, no. 2, pp. 1352–1364, 2012. View at: Publisher Site  Google Scholar  MathSciNet
Copyright
Copyright © 2018 Jing Li. 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.