Research Article | Open Access

# Formulation and Simulations of the Conserving Algorithm for Feedback Stabilization on Rigid Body Rotations

**Academic Editor:**Her-Terng Yau

#### Abstract

The problem of stabilization of rigid bodies has received a great deal of attention for many years. People have developed a variety of feedback control laws to meet their design requirements and have formulated various but mostly open loop numerical algorithms for the dynamics of the corresponding closed loop systems. Since the conserved quantities such as energy, momentum, and symmetry play an important role in the dynamics, we investigate the conserved quantities for the closed loop control systems which formally or asymptotically stabilize rigid body rotation and modify the open loop numerical algorithms so that they preserve these important properties. Using several examples, the authors first use the open loop algorithm to simulate the tumbling rigid body actions and then use the resulting closed loop one to stabilize them.

#### 1. Introduction

The ideas of modern geometry may always find a role in the applications of the engineering sciences. Through geometry people can explore the structure of nonlinear problems in a natural and intuitive way. Feedback control of a rotating rigid body has become one of such research subjects. The model remains of fundamental interest from both a theoretical and applications point of view. From a theoretical point of view the nonlinear rigid body dynamics provides an important vehicle for the development of nonlinear control theory [1, 2]. At the same time the rigid body equations of motion appear in important applications ranging from spacecraft attitude control [3] to industrial robots [4].

For many systems it is essential that the algorithms used to simulate the dynamics produce physically meaningful results. To achieve this end algorithms should be based on physically sound models and capture without approximation the important physical characteristics of the actual system. Such quantities include symmetry, energy, momentum, Poisson, and symplectic structures. Several algorithms which preserve such invariants have been studied in detail. Early work in this area includes that of [5] who looked at energy and momentum conserving algorithms, [6] who focused on the integration of Poisson structure, [7] who considered algorithms which preserved symplectic structure, and [8] who used an imposed Lie-Poisson structure to determine the rigid body trajectory in Euclidean space. The conservation of such quantities is crucial in meaningful numerical simulation of systems possessing such structure. For example, consider the dynamics of a spin stabilized satellite. Such a satellite may have a rotational period on the order of several rotations per minute for the mission duration on the order of years. Failure to conserve angular momentum when simulating such a system will lead to significant errors and inaccurate conclusions about system performance.

In the area of stability analysis of uniform rigid body rotation the geometric framework has seen some development of methods. The energy-Casimir method was used in the context of Lie-Poisson systems to find stabilizing feedback control laws [9, 10]. A class of feedback control laws for the stabilization of uniform rigid body rotation was introduced in [11]. The energy and momentum conserving algorithms described in [12] were used as the basic methodology for the numerical validation of these stabilizing control laws. These algorithms were suitably modified to incorporate feedback controls based on the methodology introduced and developed in these papers.

In this paper we will discuss the modifications which are necessary to apply the algorithm introduced in [12] to rigid body motion with feedback. While the modifications are straightforward they raise important issues with regard to numerical simulation of such systems. The results represent special cases of algorithms which conserve energy and momentum for general Hamiltonian systems [13, 14]. The remainder of the paper is then as follows. In the next section we outline the formulation of rigid body dynamics from a geometric point of view. We then show how the dynamics are modified when feedback is applied to the system. The following section then discusses the energy and momentum conserving algorithm. We then introduce and justify the modifications to the algorithm in the presence of feedback. We conclude this paper with several examples.

#### 2. Rigid Body Dynamics

The unforced dynamics of a rigid body free to rotate about a fixed point possess two conserved quantities, the kinetic energy and the (spatially referenced) angular momentum. These quantities are constant with respect to unforced motion of the rigid body. If we allow this motion to be modified by state feedback, it is a remarkable fact that the closed loop systems also possess two quantities analogous to the energy and momentum of the original system [9].

##### 2.1. The Open Loop Rigid Body Dynamics

The dynamics of the rigid body free to move about a fixed point benefit from a geometric description [15, 16]. The configuration of the rigid body at any time can be described by an element of the special orthogonal group, that is, the set of all orthogonal matrices with determinant equal to one. We denote this group as . This group is a Lie group.

If we consider a motion of this rigid body this is represented by a continuous curve of elements of parameterized by time. The tangent space to any point in consists of the tangent vectors to all the possible curves passing through such a point; we denote it by . Since is a Lie group, it has an associated Lie algebra which we denote by . We can identify any vector in the tangent space with two elements in the Lie algebra of by translating this element to the identity by left or right translation. These two elements in the Lie algebra correspond to the convected angular velocity and the spatial angular velocity . In addition to the tangent space at the current configuration we can define a cotangent space through the duality pairing . As with an element of the tangent space, an element of the cotangent space can be translated to two elements in the dual to the Lie algebra . For the natural pairing these two elements correspond to the convected angular momentum and the spatial angular momentum .

The rigid body is a Hamiltonian system which has a phase space, a Hamiltonian, and a symplectic form. The phase space is denoted by and defined as the cotangent bundle of Locally we coordinatize elements of this phase space as with a rotation matrix and a three-element angular momentum vector. We define a Hamiltonian function on this phase space. In spatial coordinates Here denotes the spatially referenced inertia matrix and is the body fixed inertia. Hamiltonian’s equations are then Application of the Legendre transformation yields where lies in the space of Lie algebra with the standard isomorphism . Note that represents the set of real numbers. By standard arguments for Hamiltonian systems one then shows that the energy is conserved [2].

For the rigid body the symmetry induced by the action of on the phase space provides an additional conserved quantity, the angular momentum. This symmetry is used to define a momentum map corresponding to the invariance under rigid body rotations. It is easily shown that this corresponds to the classical notion of angular momentum; that is

##### 2.2. The Closed Loop System

Application of state feedback can be used to stabilize the uniform rotation of the rigid body about an arbitrary axis in space. Such state feedback modifies the vector field corresponding to rigid body motion. In what follows we consider feedback of the velocity components of the rigid body. Equation (3) is now where is an external moment applied to the system.

Consider a general form of velocity feedback for the rigid body given by where , and , are constant matrices. Using (7) in (6) we obtain the closed loop dynamics

Remarkably, with a more general definition of the phase space this system possesses conserved quantities analogous to the energy and momentum of the free rigid body. In what follows we will consider a special case of (8) by setting in (7). Such feedback arises, for example, in the case of a spacecraft carrying momentum wheels. The second equation of (8) then takes the form

The phase space of this system is the cotangent bundle of . We define the comomentum vector as . The vector has the effect of “shifting” the angular momentum due to the rotation of the rigid body. It is straightforward to verify that along the trajectory. The Hamiltonian has the property that along the flow given by (8) from which we conclude that the Hamiltonian is constant.

As before there exists a momentum map which is conserved by the flow. This momentum map reflects the invariance of the dynamics with respect to rigid body rotations. It is shown that and that is then a direct consequence of Noether’s theorem [2].

#### 3. Conserving Algorithms

Discretization of the closed loop dynamics (4) will not in general preserve the conserved quantities of energy and momentum. In fact, standard numerical methods such as Runge-Kutta or direct integration will in general remain valid for only short periods of time. For long term dynamics to retain the conserved quantities we must use algorithms which have been designed for this purpose.

Reference [17] developed a Lie-Poisson Hamilton-Jacobi theory leading to a symplectic integrator that preserves exactly the Lie-Poisson structure but does not typically conserve the energy. Actually it showed that the energy conserving algorithms cannot be symplectic at the same time in the nonintegrable or reduced space. Another almost Poisson symplectic integrator introduced by [18] with mid-point rule conserves the first integrals containing only linear and quadratic terms, especially the energy, but only conserves the Poisson structure up to the second order. Reference [12] constructed energy-momentum algorithms by balancing the spatial angular momentum which also has the second order accuracy in the Poisson structure that is compared with the symplectic integrator in [13].

In contrast with the previous algorithms for the open loop systems, we are interested in the closed loop systems based on the energy-momentum algorithm with a family of stabilizing feedback introduced in the work of [19]. The idea can be found in [15, 16] that for the Hamiltonian system (rigid body rotation in this case) with symmetries induced by the action of a Lie group ( here) on the phase space, there exist conserved energy and momentum map along the integral line of the dynamics. The reason we choose energy-momentum conserving algorithm is that the spatial angular momentum plays the most important role in the rigid body rotation and is dealt with explicitly in this algorithm.

##### 3.1. Energy-Momentum Conserving Algorithm for Open Loop System

We first review the open loop energy-momentum conserving algorithm of [12] in this section and then discuss the modifications for the closed loop system in the following section.

The equations of motion of a rigid body in spatial coordinate are expressed in (4). They can be interpreted in body coordinate with applied torque as with initial conditions, where is an element of the configuration space, is an element of the velocity field, is the body fixed applied torque, and is the body fixed moment of inertia.

The update of the configuration here is the exponential map exp: from the Lie algebra to the group, which has the closed form called Rodrigues formula where is the convected relative rotation vector lying in the linear vector space of Lie algebra.

Therefore the open loop energy-momentum conserving algorithm for the initial value problem (12) is based on the Newmark algorithm [20] outlined as follows.

For a typical time interval with the known variables , , , , and where is the convected angular acceleration, we let to be zero initially.

*Step 1. *

*Step 2. *

*Step 3. *

*Step 4. *If *∥***R***∥* < Tolerance, then

Let , go to Step 1.

Else

*Step 5. *

*Step 6. *

, go to Step 2.

To accomplish the iteration by the Newton-Raphson method we need to linearize (18) about . Equation (18) is nonlinear in the finite rotation vector **. **By [21] the linearization needs the following operations of the directional derivative in the direction Δ
where is the directional derivative of in the direction and is a linear map having the expression
Thus the tangent matrix calculated by linearization is derived. We will use these equations again to derive new tangent matrix for the closed loop systems later.

It can be shown that for the choice of this algorithm conserves energy exactly and thus is unconditionally stable [12]. Moreover, if we choose and , the updated angular acceleration does not depend on the initial during each time interval and we may avoid the accumulated errors from . Moreover, it can also be proved that if, in addition, we use the trapezoidal rule for the applied torque, that is, , then the algorithm is second order accurate both in configuration and velocities.

##### 3.2. New Result for Closed Loop System

When we close the loop with the linear stabilizing feedback of by energy-momentum method mentioned in [20], (12) become which are the equations of motion for the closed loop system in body coordinate.

As in Section 2.2 we define the convected shifted angular momentum . Clearly the norm of is constant along the flow. We can also define the Hamiltonian in the dual Lie algebra, or as normally in the Lie algebra, and both can be easily seen to be conserved.

Since we have closed the system with the constant feedback gain, there is no need to trace the control input and we do not need the parameter anymore in our algorithm. We only have to set the constant vector beforehand.

In the closed loop energy-momentum conserving algorithm we hope to have the same nice properties as those in the open loop one. We can achieve that by modifying the algorithm in the previous section. First, with the open loop algorithm at hand (24) can be discretized in the form between any typical time interval with the following: It can be proved that the norm of the shifted angular momentum is conserved in the closed loop algorithm when .

In addition to conservation of norm of the shifted momenta the direction of the shifted spatial angular momentum is also conserved if we enforce that . To do this we just replace Step 3 in the previous section by to modify the algorithm. Note that the linear feedback needs not to stabilize the rigid body rotation. In general, any feedback in the form would conserve the shifted spatial angular momentum which is actually the momentum map for the Hamiltonian system. We will see this in some examples later.

The conservation of energy depends on properly choosing the parameters and as well. From the kinematic equations (16), (17) and the fact that we update where . Besides, (16) yields . By eliminating in the previous equations and substituting into the balance equation it turns out to be the following:

It can also be proved that the energy is conserved in the closed loop algorithm when . Again, if we choose the parameters and , we are free from the error propagation of angular acceleration and the closed loop algorithm would be second order accurate. Moreover, it is unconditionally stable since the energy is conserved.

The linearization process of (18) starts from the balance equation (29) with the orientation update (17)
which is a nonlinear equation in . Define
then the linearization of** G**() with respect to becomes
where _{0} is the fixed point at which the linearization is exerted. By (22) and (23) with the definition (32), we can compute the linearization of along in body coordinate as follows:

Note that there is a term in the tangent matrix that is different from the result (20) of open loop system. This means we need to put one more term in dealing with the linearization of the balance equation for the closed loop system.

Based on the analysis above we treat the constant vector as a controller and put it inside the algorithm. Modify the linearization process in the previous section and replace the momenta and by and to construct the new closed loop algorithm.

#### 4. Numerical Examples

There are three examples that we are going to discuss in this section. The first two examples are rigid body rotations about the intermediate and arbitrary axes. The last example is a rotation with the asymptotic stabilizing control.

##### 4.1. Intermediate Axis Stabilizing Control

The linear feedback introduced here is based on the energy-momentum method and is a robustly stable controller in the face of uncertainties of moment of inertia. We will use the open loop algorithm to simulate the tumbling action and then use the closed loop one to stabilize it.

Consider a rigid body with moment of inertia rotating about the intermediate axis with the convected angular velocity which corresponds to the convected angular momentum .

Initially we perturb the angular velocity a little bit to so that the numerical instability occurs. See Figure 1. Without applied torque the rigid body tumbles and its convected angular momentum is shown in Figure 2(a). The energy* H* and momentum map are conserved in Figures 2(b) and 2(c), respectively.

**(a)**

**(b)**

**(c)**

With the stabilizing vector corresponding to (see [19]) the closed loop algorithm generates the constant shifted momenta and in Figure 3, while the original loses its stability. Actually is our momentum map in this case. The energy in Figure 3(c) shows that the closed loop system is Hamiltonian.

**(a)**

**(b)**

**(c)**

Strictly speaking, is the stabilizing control vector for instead of the perturbed ; therefore the shifted body angular momentum actually oscillates nearby the axis due to the initial and the oscillation cannot be eliminated by our control vector . We will resolve this problem by the variable structure control later in Section 4.3.

##### 4.2. Arbitrary Axis Stabilizing Control

Consider the same rigid body rotating about an arbitrary axis with and .

Without applied torque the system’s convected momentum tumbles as shown in Figure 4 and the conserved energy* H* and momentum map are shown in Figure 5.

**(a)**

**(b)**

**(c)**

Applying the stabilizing vector , corresponding to again, in the closed loop algorithm the energy* H*, momentum map , and stabilized convected momentum are stable in Figure 6.

**(a)**

**(b)**

**(c)**

In addition, we apply the same vector to the rotation of the same system about another arbitrary axis . As expected before, we can observe in Figure 7 that the energy* H* and momentum map are still conserved, just like the unforced rigid body rotations.

**(a)**

**(b)**

##### 4.3. Asymptotic Stabilizing Control

In (7) the quadratic gyroscopic control modifies the phase flow in order to make some designated axes become equilibria, and the linear part shifts the angular momentum to do the same job. In what follows, we consider the special case (or in body coordinates) by letting .

If the initial body angular momentum of a closed loop rigid body system is away from any of the stable equilibria, the angular momentum will follow a periodic orbit about that equilibrium on the momentum ball. We say this equilibrium is Lyapunov stable in contrast with asymptotically stable.

For different feedback controls there are different shapes of the periodic orbits, especially the orbit of the body angular momentum projected on the plane perpendicular to the stabilized axis. Based on this fact, we can develop an asymptotic stabilizing control to asymptotically pull the initially perturbed angular momentum back to the designated equilibrium axis by using the variable structure control method. We next give an example to clarify this idea.

Consider the same rigid body with the initial body angular velocity (or angular momentum ) as in Section 4.1. This system rotates about the intermediate axis and thus is unstable. The projected phase flow around the intermediate axis on **-** plane is plotted in Figure 8. It shows that the intermediate axis is a saddle point.

With the feedback control law the closed loop equation becomes where is the modified moment of inertia.

The first quadratic stabilizing control matrix in this example is chosen to be and the associate modified moment of inertia and control law are

respectively. Figure 9 shows its phase flow on **-** plane. We can see the rotation about the intermediate axis (the center) has been stabilized and any of other rotations deviating from the center undergoes a periodic motion. Observe that in the first and third quadrants the flow goes away from the origin and in the second and fourth quadrants the flow goes near the center.

The second stabilizing control matrix we use is and its modified moment of inertia and control law are respectively. We plot the phase flow in Figure 10. Again, we observe that the flow in the first and third quadrants approaches the center and the flow in the second and fourth quadrants goes in the other way.

In order to asymptotically stabilize the rotation near the intermediate axis we combine these two control laws and take advantage of both feedbacks in alternative quadrants by switching; that is,

Figure 11 demonstrates the simulation of the trajectory on **-** plane when starting at . As we expect the angular momentum asymptotically approaches the intermediate axis. Once the approach achieves some small level, the switching control can be turned off and any of stabilizing control family can be used to keep the intermediate axis rotation stable.

It should be noted that when the angular momentum is away from the equilibrium both control laws do work on the system. Therefore, the energy is changing but converges to a constant associated with the intermediate axis rotation, and the spatial angular momentum has an attitude drift in space. As long as the initial perturbation is not large the deviations in both properties would not be significant.

#### 5. Conclusion

In this paper we have outlined the formulations of rigid body dynamics from a geometric point of view for both open loop systems and closed loop ones with a family of the stabilizing linear feedback. It turns out that the momentum map of the closed loop system needs to be modified such that it preserves the analogous conserved quantities as well as the open loop system. To be more specific, we have to translate the spatial angular momentum by an amount of the constant feedback gains B and calculate all properties in this shifted dual to the Lie algebra. We also reviewed the energy-momentum conserving algorithm and made some modifications for the closed loop systems. We derived the conditions of choosing the parameters of Newmark algorithm to make the modified conserving algorithm unconditionally stable and second order accurate and conserve the magnitude and direction of momentum and the energy. A correction term also needs to be placed into the tangent matrix in the linearization process. Several numerical examples have been used to demonstrate the validity of the closed loop algorithm. The energy and shifted momentum map are conserved in these cases, and even if the feedback vector** B** does not stabilize the system.

#### Conflict of Interests

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

#### References

- D. D. Holm,
*Geometric Mechanics—Part II: Rotating, Translating and Rolling*, Imperial College Press, London, UK, 2008. View at: MathSciNet - J. E. Marsden and T. S. Ratiu,
*Introduction to Mechanics and Symmetry: A Basic Exposition of Classical Mechanical Systems*, vol. 17 of*Texts in Applied Mathematics*, Springer, New York, NY, USA, 2nd edition, 1999. View at: Publisher Site - D. Kim, J. D. Turner, and H. Leeghim, “Reorientation of asymmetric rigid body using two controls,”
*Mathematical Problems in Engineering*, Article ID 708935, 8 pages, 2013. View at: Google Scholar | MathSciNet - J. M. Selig,
*Geometric Fundamentals of Robotics*, Monographs in Computer Science, Springer, New York, NY, USA, 2nd edition, 2005. View at: MathSciNet - R. A. Labudde and D. Greenspan, “Energy and momentum conserving methods of arbitrary order for the numerical integration of equations of motion. II. Motion of a system of particles,”
*Numerische Mathematik*, vol. 26, no. 1, pp. 1–16, 1976. View at: Publisher Site | Google Scholar | Zentralblatt MATH | MathSciNet - M. A. Austin, P. S. Krishnaprasad, and L. S. Wang, “Almost poisson integration of rigid body systems,”
*Journal of Computational Physics*, vol. 107, no. 1, pp. 105–117, 1993. View at: Publisher Site | Google Scholar | Zentralblatt MATH | MathSciNet - P. J. Channell, “Symplectic integration algorithms,”
*Los Alamos National Laboratory Internal Report*AT-6:ATN-83-9, 1983. View at: Google Scholar - C. Linton, W. Holderbaum, and J. Biggs, “Rigid body trajectories in different 6D spaces,”
*ISRN Mathematical Physics*, vol. 2012, Article ID 467520, 21 pages, 2012. View at: Publisher Site | Google Scholar | Zentralblatt MATH - A. M. Bloch and J. E. Marsden, “Stabilization of rigid body dynamics by the energy-Casimir method,”
*Systems & Control Letters*, vol. 14, no. 4, pp. 341–346, 1990. View at: Publisher Site | Google Scholar | Zentralblatt MATH | MathSciNet - A. M. Bloch, P. S. Krishnaprasad, J. E. Marsden, and G. S. de Alvarez, “Stabilization of rigid body dynamics by internal and external torques,”
*Automatica*, vol. 28, no. 4, pp. 745–756, 1992. View at: Publisher Site | Google Scholar | Zentralblatt MATH | MathSciNet - R. Zhao and T. A. Posbergh, “Feedback stabilization of uniform rigid body rotation,”
*Systems & Control Letters*, vol. 22, no. 1, pp. 39–45, 1994. View at: Publisher Site | Google Scholar | Zentralblatt MATH | MathSciNet - J. C. Simo and K. K. Wong, “Unconditionally stable algorithms for rigid body dynamics that exactly preserve energy and momentum,”
*International Journal for Numerical Methods in Engineering*, vol. 31, no. 1, pp. 19–52, 1991. View at: Publisher Site | Google Scholar | Zentralblatt MATH | MathSciNet - D. Lewis and J. C. Simo, “Conserving algorithms for the dynamics of Hamiltonian systems on Lie groups,”
*Journal of Nonlinear Science*, vol. 4, no. 3, pp. 253–299, 1994. View at: Publisher Site | Google Scholar | Zentralblatt MATH | MathSciNet - J. C. Simo, N. Tarnow, and K. K. Wong, “Exact energy-momentum conserving algorithms and symplectic schemes for nonlinear dynamics,”
*Computer Methods in Applied Mechanics and Engineering*, vol. 100, no. 1, pp. 63–116, 1992. View at: Publisher Site | Google Scholar | Zentralblatt MATH | MathSciNet - R. Abraham and J. E. Marsden,
*Foundations of Mechanics*, AMS Chelsea, Rhode Island, RI, USA, 2nd edition, 2008. - V. I. Arnold,
*Mathematical Methods of Classical Mechanics*, Springer, New York, NY, USA, 1997. View at: MathSciNet - G. Zhong and J. E. Marsden, “Lie-poisson Hamilton-Jacobi theory and lie-poisson integrators,”
*Physics Letters A*, vol. 133, no. 3, pp. 134–139, 1988. View at: Publisher Site | Google Scholar | MathSciNet - M. A. Austin, P. S. Krishnaprasad, and L. S. Wang, “Almost poisson integration of rigid body systems,”
*Journal of Computational Physics*, vol. 107, no. 1, pp. 105–117, 1993. View at: Publisher Site | Google Scholar | Zentralblatt MATH | MathSciNet - R. Zhao and T. A. Posbergh, “Robust stabilization of a uniformly rotating rigid body,” in
*Proceedings of the American Control Conference*, pp. 2408–2412, June 1993. View at: Google Scholar - T. J. R. Hughes,
*The Finite Element Method: Linear Static and Dynamic Finite Element Analysis*, Dover Publications, Mineola, NY, USA, 2000. View at: MathSciNet - J. C. Simo and L. Vu-Quoc, “On the dynamics in space of rods undergoing large motions—a geometrically exact approach,”
*Computer Methods in Applied Mechanics and Engineering*, vol. 66, no. 2, pp. 125–161, 1988. View at: Publisher Site | Google Scholar | Zentralblatt MATH | MathSciNet

#### Copyright

Copyright © 2014 Yong-Ren Pu and Thomas A. Posbergh. 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.