## Serviços Personalizados

## Artigo

## Indicadores

- Citado por SciELO
- Acessos

## Links relacionados

- Citado por Google
- Similares em SciELO
- Similares em Google

## Compartilhar

## DYNA

##
*versão impressa* ISSN 0012-7353

### Dyna rev.fac.nac.minas vol.81 no.185 Medellín maio/jun. 2014

#### http://dx.doi.org/10.15446/dyna.v81n185.35756

http://dx.doi.org/10.15446/dyna.v81n185.35756

**The dynamic model of a four control moment gyroscope system**

**Modelo dinámico de un sistema de control de par por cuatro giróscopos**

**Eugenio Yime-Rodríguez ^{a}, César Augusto Peña-Cortés ^{b} & William Mauricio Rojas-Contreras ^{c}**

^{a }*Facultad de Ingenierías, Universidad Tecnológica de Bolívar, Colombia. eyime@unitecnologica.edu.co ^{b} Facultad de Ingenierías y Arquitecturas, Universidad de Pamplona, Colombia. cesarapc@unipamplona.edu.co ^{c} Facultad de Ingenierías y Arquitecturas, Universidad de Pamplona, Colombia. mrojas@unipamplona.edu.co*

**Received: November 28 ^{th}, 2012. Received in revised form: February 20^{th}, 2014. Accepted: May 9^{th}, 2014.**

**Abstract **The dynamic model of a Four Control Moment Gyroscope (4-CMG) is traditionally obtained after computing the derivative of the angular momentum equation. Although this approach leads to a simple dynamic model, new models have been introduced due to terms not taken into account during the computation of the angular momentum equation. In this paper, a new dynamic model for a 4-CMG based on the Newton-Euler algorithm, which is well accepted in Robotics, was developed. This new approach produces a complete dynamic model.

*Keywords:* dynamics, gyroscope, model; control.

**Resumen **El modelo dinámico de un sistema de control de par utilizando cuatro giróscopos (4-CMG) tradicionalmente se obtiene al calcular la derivada de la ecuación del momento angular total. Aunque este enfoque conduce a un modelo dinámico relativamente simple, recientemente se han introducido nuevos modelos debido a términos que no se han tenido en cuenta, o se desprecian, durante el cálculo de la ecuación del momento angular. En este artículo, se propone un nuevo modelo dinámico para un 4-CMG basado en el algoritmo de Newton-Euler, el cual es bien aceptado en robótica. Con este nuevo enfoque se logra obtener un modelo dinámico bastante completo.

*Palabras clave:* dinámica; giróscopo; modelo; control.

**1. Introduction**

A Four Control Moment Gyroscope (4-CMG) is an angular momentum exchange device used on satellites [1-3], submarines [4, 5], to control attitude. It is composed by four gyroscopes arranged in a pyramidal form, see Fig. 1, with the torque amplification property being its principal advantage [6]. Moreover, when used in satellites no fuel or gas propellant is required, because the motors use electricity to operate.

The dynamic model of a 4-CMG is usually obtained by differentiation of the angular momentum equation [7]. This is done in [3, 4] and [8]. Probably the most exact dynamic model using this approach is the developed by Ford and Hall, [8].

The first comparison between a robot arm and a 4-CMG was performed by Bedrossian et al. [9]; in this work an analogy of velocities was considered to study the singularities on a 4-CMG. No further analogies with robot arms were stated.

In this paper a kinematics comparison between a 4-CMG and a robotic arm is used to develop a new dynamic model. The advantages of this approach are: use of a widely accepted methodology to compute a dynamic model, and more precise equations.

**2. Dynamic equations for A CMG**

Fig. 1 illustrates a CMG with four gyroscopes, each of them composed of a flywheel and a gimbal. A coordinate frame , , , is located at the center of the flywheel, which serves as a reference for the motion of gimbals and flywheels. The flywheels turn at a constant speed, while the gimbals can rotate around axis without any restriction. The angle of rotation of a -th gimbal is represented by , with the zero position being illustrated in the figure. The position of the four gyroscopes is denoted by the vector . The angle b is the pyramid's skew angle.

Fig. 2 illustrates the equivalent open kinematics chain for a 4-CMG; there the circles represent rotational joints.

To compute the dynamic model, two steps are performed, see Fig. 3. The first step is the Newton-Euler algorithm for each gyroscope, this led to the reaction forces and moments applied to the base body. The second step is the dynamic equation for the base body, where the reaction forces and moments exerted by each gyroscope, and , are involved. The angular and linear velocity of the base body, and respectively, plus the angular velocities of each joint, and are required in the Newton-Euler algorithm to perform the direct kinematics of the gyroscopes [10, 11].

Computation of the Newton Euler Equations for a serial robot is also done using two steps, Tsai [12]. The first one is the kinematics calculus toward the extreme of the robot, as shown in Table 1.

The second step is the dynamic calculus of backward computation, as can be seen in Table 2. Note, only rotational joints are considered in both tables.

The following assumptions have been made to simplify the equations of the Newton-Euler methodology:

- Mass and inertia of the gimbals are approximately zero or negligible.
- The center of mass of the Flywheel is aligned with the gimbal axis.
- Velocity and acceleration of the base body are not equal to zero.

The mass and inertia of the gimbal frame is neglected because the flywheel has the major contribution in the mass and inertia of the gyroscopes.

**2.1. Data of the links **For the Newton-Euler approach, one gyroscope is composed of three links: base body, gimbal and flywheel. Each of these links is joined by a rotational joint, Fig. 3.

Before computing the forward kinematics and backward dynamics, each link must have a coordinate frame. Fig. 4 illustrates the frames and vectors defined for each link. A new frame, , is used to express the forces and moment exerted by the gyroscopes. This frame is fixed in the base body. The other two frames are and , with the former being the frame of the gimbals link and the latter being the frame of the flywheel link. These two frames are located at the same point, the center of the flywheel. The homogeneous matrix between the frames fixed in the base body, and , is,

Where , , , and stands for , , , and respectively; is the radius of the circle where the gyroscopes are located; is the angle of the turn around axis to align with , and it has any of the values of radians.

The Denavit-Hantemberg parameters for one gyroscope according to Fig. 4, are shown in Table 3. In this table , where is the vector from frame to frame .

1) Homogeneous Transformation Matrices: The DH transformation matrices for each link can be also computed, these are:

2) Position Vectors: The position of the frame with respect to is defined by vector . The vector defines the position of related to . The mass centre of each link is defined by vectors and . These vectors have the following values,

is zero because the mass and inertia of the gimbals are neglected.

3) Inertia and mass for links: For both links the values of mass and inertia are,

4) Base Body conditions: Different to a typical robot, the base body of a 4-CMG is in motion, which allows it to have an angular and linear velocity as well as non-zero acceleration.

**, ****, ****, ****, **not equal to zero.

**2.2. Forward Kinematics **The following equations are derived after using the forward kinematics, table 1.

1) First link - gimbal axis: The first link has the following velocity and acceleration.

Angular Velocity

Angular Acceleration

Linear Velocity

Because ** **and ** **are parallel.

Linear Acceleration

Acceleration of the center of mass

2) Second Link - flywheel axis: Preforming the same steps, as the first link, the results are,

Angular Velocity

Angular Acceleration

Linear Velocity

Linear Acceleration

Acceleration of the center of mass

**2.3. Backward Dynamics **The following dynamics equations for one gyroscope are obtained after applying the equations in table 2.

1) Second Body: By using backward dynamics, the torque required by the flywheel motor can be computed as the Inertial Forces and Moments

Where the following relations were used,

Forces and Moments in the center of mass

Torque in joint

2) First Body: In these steps the torque required by gimbal motor and the reaction moments and forces in the base body are computed. Inertial Forces and Moments

Forces and Moments in the center of mass

Torque in Joint

**2.4. Dynamic Equation for Base Body**

The total force and moment exerted on the base body, is the sum of the force and torque for each gyroscope's equation, (32) and (33).

If , , , and are defined by the following expressions,

Then eq. (32)-(33) are expressed in terms of base body variables,

The equation of forces is obtained after replacing (45) in (35). This preliminary result is simplified if the relationship for is used in conjunction with the fact that for a symmetrical 4-CMG the vectors are,

The final equation is,

Before computing the dynamic equation for moments, the expression is simplified by using the following relations,

The obtained result is,

It is a common practice to represent the torque's equation in the base body coordinate frame. In this frame, the following matrices are defined,

Where is the matrix equivalent of the cross product,

Therefore, the torque equation over the base body is then expressed as,

Finally, the torque eq. (34) and (29), can be rearranged and expressed in base body coordinates as,

These equations are useful to select the motors for each actuated joint [13].

**3. Numerical example**

The eq. (74) and (75) are useful for computing the motor requirements, while equation (63) is used to create a steering control law for the 4-CMG as is done in [14]. In the case of a flywheel motor, eq. (74), only the last term is traditionally taken into account to compute the required torque, but a numerical simulation can show how the proposed equations are better than the traditional approach.

Let us assume a flywheel with inertia of 0.16 in x and y axis and a value of 0.308 in z axis, which is rotating at a speed of 10000 rpm. If the body has an angular velocity and acceleration, it is clear in eq. (74) than the first two terms contribute to the total torque. Fig. 5 illustrates the results obtained for a unit angular velocity and acceleration. The continuous line represents the torque computed with eq. (74), while the dotted line is the torque computed using the traditional approach.

**4. CONCLUSIONS **

A new dynamic model for a 4-CMG was derived using the Newton-Euler algorithm, a methodology commonly used in Robotics. Although some simplifications were done, the dynamic model is useful to study the behavior of a 4-CMG. The obtained dynamic model can also be used for computing a control law for a 4-CMG. Torque equations for the rotational joints were also found. A simulation was performed to illustrate the benefit of the proposed equations. These equations are also useful to compute and help in selecting the proper motors that will drive the joints.

**References**

**[1]** Kuhns, M. and Rodriguez, A. Singularity avoidance control laws for a multiple CMG spacecraft attitude control system, Proceedings of the American Control Conference (ACC), pp. 2892–2893, 1994. [ Links ]

**[2]** Kuhns, M. and Rodriguez, A. A preferred trajectory tracking steering law for spacecraft with redundant CMGS, Proceedings of the American Control Conference (ACC), pp. 3111–3115, 1995. [ Links ]

**[3]** Oh, S. and Vadali, S. R. Feedback control and steering laws for spacecraft using single gimbal control moment gyros, Astronautical Sciences, 39 (2), pp. 183–203, 1991. [ Links ]

**[4]** Thornton, B., Ura, T., Nose, Y. and Turnock, S. Internal actuation of underwater robots using control moment gyros, Proceedings of Oceans, pp 591–598, 2005. [ Links ]

**[5]** Thornton, B., Ura, T. and Nose, Y. Wind-up AUVs: Combined energy storage and attitude control using control moment gyros. Proceedings of Oceans, pp. 1-9, 2007 [ Links ]

**[6]** Lappas, V. J., Steyn, W. H. and Underwood, C. I. Torque amplification of control moment gyros, IEEE Electronics Letters, 38 (15), pp. 837–839, 2002. [ Links ]

**[7]** Tekinalp, O., Elmas, T. and Yavrucuk, I. Gimbal angle restricted control moment gyroscope clusters, Proceedings of 4th International Conference on Recent Advances in Space Technologies (RAST), pp. 585-590, 2009. [ Links ]

**[8]** Ford, K. A. and Hall, C. D. Singular direction avoidance steering for control-moment gyros, Journal Guidance Control and Dynamics, 23 (4), pp. 648–656, 2000. [ Links ]

**[9]** Bedrossian, N. S., Paradiso, J., Bergmann, E. V. and Rowell, D. Redundant single gimbal control moment gyroscope singularity analysis, Journal Guidance Control and Dynamics, 13 (6), pp. 1096–1101, 1990. [ Links ]

**[10]** Toz, M. and Kucuk, S. A comparative study for computational cost of fundamental robot manipulators, Proceedings of International Conference on Industrial Technology (ICIT), pp. 289-293, 2011. [ Links ]

**[11]** Negrean, I., Schonstein, C., Negrean, D.C., Negrean, A.S. and Duca, A.V. Formulations in robotics based on variational principles, Proceeding of International Conference on Automation Quality and Testing Robotics (AQTR), pp. 1-6, 2010. [ Links ]

**[12]** Tsai, L. W. Robot Analysis: The Mechanics of Serial and Parallel Manipulators. Jon Wiley & Sons, Inc., 1999. [ Links ]

**[13]** Jaramillo, A. Franco, E. Guasch, L. Estimación de parámetros invariantes para un motor de inducción. Dyna, 78 (169), pp. 88–94, 2011. [ Links ]

**[14]** Yime, E., Quintero, J., Saltaren R. and Aracil R. A new Approach for Avoiding Internal Singularities in CMG with Pyramidal Shape Using Sliding Control. Proceedings of European Control Conference (ECC), pp. 125-132, 2009. [ Links ] ;

**E. Yime-Rodríguez** is a Mechanical Engineer, graduated from Universidad del Norte, with a PhD in robotics, from Universidad Politecnica de Madrid, who actually work for Universidad Tecnologica de Bolivar, located in Cartagena, Colombia. His major research areas are parallel and serial robotics, with emphasis in kinematics, dynamics and nonlinear control. Recently he has gained significant experience in mechanical and mechatronics design applied to robotics. He can be contacted to eyime@unitecnologica.edu.co

**C. A. Peña-Cortés** has been a Professor at Universidad de Pamplona in the Department of Mechatronics, Mechanics and Industrial Engineering since 2004. He received the Electromechanic Engineering degree in 2001 from Universidad Pedagógica y Tecnológica de Colombia, an MSc Degree in Electronics and Computers Engineering in 2003 from Universidad de los Andes, and his PhD degree in Automatics and Robotics from Universidad Politécnica de Madrid in 2009. His researches are focused on Service Robots, Telerobotics and Parallel Robots.

**W. M. Rojas-Contreras** is full professor of the Pamplona University. He became a systems engineer in Francisco de Paula Santander University. He received specialist degree from Industrial University of Santander. He obtained a master degree in computer science from Autonomous University. He is candidate to PhD in Applied Sciences from Andes University. Now, he is Dean of Engineering and Architecture Faculty and head of Computer Science research Group. His researches are focused on software engineering and project management software.