## Abstract

The classical approach to the problem of synthesizing an optimal attitude manoeuver trajectory, involves the use of the calculus of variations and the use Lagrange multipliers or co-states. The nonlinear large attitude manoeuver trajectory is controlled by a set of nonlinear evolving co-states. In this paper, following a review of the methodologies available for trajectory synthesis followed by tracking control, the optimal trajectory for a typical optimal attitude manoeuver is synthesized by solving for the states and co-states defined by a two point boundary value problem. Gravity gradient torques are included as a matter of course. Following the synthesis of the optimal attitude-rate trajectory, tracking control laws are synthesized by re-formulating the optimal control as a feedback law. The approximate linear tracking feedback controls are evaluated by relating the optimal state and co-state vector by a linear relation. The control laws are synthesized numerically. The problem of optimal attitude orientation trajectory synthesis is also addressed. The methodologies are applied to typical sample problems and results are presented. Quantitative comparisons of the results of the methods are made to the results obtained by the application of other linear and nonlinear methods, to illustrate the key features of the methodologies.

### Keywords

- attitude manoeuvers
- optimal manoeuver trajectory
- trajectory optimization
- trajectory tracking
- feedback control laws

## 1. Introduction

The need for designing fast attitude and angular rate acquisition manoeuvers for a spacecraft with restricted or low actuation torqueing capacity arises in many space recent applications. Spacecraft are usually equipped with an attitude control system (ACS), which operates in one of two modes; the first mode involves maneuvering for attitude or angular rate acquisition while the second is to ensure stability. In the first mode, the ACS is responsible for acquiring and tracking an attitude or an angular rate state trajectory which could include a steady state. The requirements for this mode are set by the need to remotely capture an orbiting body, de-tumble a spacecraft, synchronize with another orbiting body or point at a specific direction in space. Although a large number of publications have appeared before the end of the last millennium on the subject of attitude stabilization and feedback control, a few recent papers have focused on the construction of optimal maneuvering trajectories synthesis for attitude or angular rate acquisition. There have been some publications related to the synthesis of optimal maneuvering trajectories for attitude or angular rate acquisition during the last two decades of the preceding millennium. Yet some significant advances have been made in the early part of this century. This includes papers by Lee et al. [1], Yoshida et al. [2], Aghili [3, 4], Yang and Wu [5], Liu et al. [6], and Zhang et al. [7], who have considered the maneuvering for attitude or angular rate acquisition problems using classical methodologies. Sharma and Tewari [8] have addressed the issue of nonlinear tracking of spacecraft attitude manoeuvers while Hegrenas et al. [9] have considered the maneuvering for attitude or angular rate acquisition problem by means of explicit model predictive control, via a nonlinear programming approach.

In dealing with the optimal attitude trajectory synthesis, several real world effects such as gravity gradient torques are generally neglected. Neglecting the gravity gradient torques can have a serious effect on the trajectory synthesis problem as (i) the gravity gradient torques can influence the stability of the spacecraft and (ii) they tend to couple the attitude rate dynamics with the quaternion kinematics. For this reason, it is not always advisable to ignore these torques on grounds of “smallness” as even the smallest of these perturbations can not only trigger instability but also induce the bifurcation of the orbit. It is the gravity that is primarily responsible for the orbital motion and the attitude stability of a spacecraft. The importance of gravity gradient torques has also been underscored by Lobo et al. [10].

The classical methodologies for trajectory synthesis compare well with other nonlinear and deterministic artificial intelligence approaches such as those developed by Sands et al. [11], Nakatani and Sands [12] and Baker et al. [13].

In this paper, the optimal trajectory for a typical attitude rate manoeuver is synthesized by solving for the states and co-states defined by a two point boundary value problem. Gravity gradient torques are included as a matter of course. Following the synthesis of the optimal attitude-rate trajectory, tracking control laws are synthesized by re-formulating the optimal control as a feedback law. The approximate linear tracking feedback controller gains are evaluated by relating the optimal state and co-state vector by a linear relation. The feedback control laws are synthesized numerically. The problem of optimal attitude orientation trajectory synthesis is also addressed. The optimization methodologies are applied to typical sample problems and results are presented. Quantitative comparisons of the results of the optimization method are made to the results obtained by the application of other linear and nonlinear control methods, to illustrate the key features of the methodologies.

## 2. Spacecraft attitude dynamics and quaternion kinematics

In matrix form, when the inertia matrix is not diagonal the equations of attitude motion of chaser spacecraft are

where

It is important to emphasize that the targets dynamics are irrelevant to us as there is little or no chance of acquiring the target’s inertia properties. However the target’s angular velocity vector is assumed to be given by

Expressions for the gravity gradient moment are obtained assuming that * z* axis of the spacecraft body is nominally pointing to the Earth. The direction vector the center of gravity of the spacecraft pointing to the Earth is given by the last column of

The corresponding cross product operator

Hence the gravity gradient moments acting on the spacecraft and manipulator body are:

Thus,

If we express the transformation from the orbiting frame to the body coordinates in terms of an attitude quaternion of the chaser spacecraft with components

then from the last column, the Earth pointing direction vector is:

The quaternion kinematics satisfies

where the quaternion

The quaternion kinematics may also be compactly expressed as

where

The desired attitude quaternion relative to the chaser’s body frame which is assumed to be

Given two quaternions,

Hence it is expressed in matrix form as

Similarly,

The traditional method of defining the attitude of a spacecraft is by the use of Euler angle sequences. The conversion of Euler angles defined as Euler angle sequences, may be converted to an equivalent quaternion set, using well-known conversion formulae, such as, those given by Smeresky et al. [14].

## 3. Formulation of the optimal angular rate trajectory synthesis problem

The first task is to formulate the optimal control problem, so it can be solved numerically. This is briefly reviewed. The attitude equations of the spacecraft may be expressed in state space form as

where
* T* is the scalar magnitude of the specific torque or torque per unit inertia,

with

When one is interested in the problem of finding the steering control

the torque direction time history is sought, such that it minimizes the cost functional:

subject to, Eqs. (18), (20) and (21).

Introducing the single state vector,

To solve the optimization problem, seven Lagrangian multipliers or co-states are introduced given by the two vectors

Hence,

The necessary conditions (Bryson and Ho [15], Conway [16]) for the first variation of

Explicitly the co-state equations are

The optimality conditions are

and

Hence,

Thus the two-parameter control vector

The choice of the sign in Eq. (34) will depend on the direction of the desired torque, forward or reverse torque. Thus the closed-loop equations of motion are

To complete the definition of the optimal solution, the boundary conditions at

The transversality conditions ensure that the initial and final states are selected optimally within the feasible regions of the states. For the transversality conditions, one may write

Thus,

The solution to the state and co-state equations, subject to the optimal control defined by Eq. (34) and the boundary conditions defined by Eqs. (36) and (37), may be found by solving a two point boundary value problem (TPBVP). This can be done using MATLAB’s function, * bvp4c.m*.

Re-considering Eq. (34), the control input vector may be expressed as

where

## 4. Feedback implementation of optimal co-states

Of interest at this stage is to be able to implement the controller, obtained in the last section, as a feedback control law. Thus, inspired by linear optimal control, it can be assumed that, locally, the co-state vector

Furthermore it is assumed that the matrix P is slowly varying and hence does not change appreciably as the time * t* changes from the current time

*to*t

**is obtained by differencing the data and solving an over determined system of linear equations by a least squares approach over a moving time window. The matrix**P

**is also constrained to be a symmetric non-negative definite matrix. Moreover**P

where

The second of Eq. (42) is used to obtain the matrix, P. Like in Eq. (34), the choice of the sign in the first of Eq. (42) will depend on the direction of the desired torque, forward or reverse torque.

## 5. Simplified formulation of the optimal angular rate trajectory synthesis problem

Some authors (for example, see Aghili [4]) have formulated the attitude rate acquisition problem without including the gravity gradient torques. Thus the quaternion kinematics could be ignored. Thus in this case one could set

## 6. Optimal attitude orientation acquisition trajectory synthesis

To begin with the quaternion kinematics is given by Eqs. (9) and (11), and can be expressed in one of two alternate forms as.

In Eq. (43), the angular velocity vector is treated as a control variable and expressed as

where the direction vector

When one is interested in the problem of finding the directional control

the angular velocity direction time history is sought, such that it minimizes the cost functional:

subject to, Eqs. (43), (44) and (45). The corresponding Hamiltonian function is

The corresponding co-state differential equations are

By using an argument similar to the one used in developing Eqs. (31)–(34), the optimal control is given by

For the co-state boundary conditions one has

Once the control is found from Eqs. (50) and (44) is used to define the angular velocity vector and Eqs. (19) and (20) to define the optimal input control torque.

## 7. Shape based optimal trajectory synthesis

An alternative approach to the optimization based on the integration of co-states is to use a shape based approach as outlined by Caubet and Biggs [18, 19]. For purposes of comparison the shape based approach serves as a useful alternative. In a shape based approach, each of the quaternion components are expressed as a summation of polynomials in terms of a time variable, multiplied by coefficients which may be determined by applying the relevant boundary conditions at the initial and final values of the time variable over a finite time frame. Thus, for example, the quaternion components are expressed as

where the coefficients

Once all the coefficients of the quaternion components

The angular velocity vector

## 8. Typical simulation examples

The first example considered the attitude dynamics is defined by Eqs. (18) and (19). Thus the gravity gradient torques acting on the spacecraft are included in the dynamic model and they are responsible for coupling the attitude quaternion kinematics and the angular velocity dynamics. The objective is to spin the spacecraft so the final angular velocity vector is given by

In all examples the solution of the TPBVP is done using MATLAB’s function, * bvp4c.m*. Whenever there was a need to solve an initial value problem, the equations were integrated using MATLAB’s

*.*ode45.m

In all cases, the time variable was made non-dimensional so it raged from [0–1]. The integration time step was chosen to be relatively small initially (

Figure 1 shows the time history of the reference quaternion components and Figure 2 shows the corresponding angular velocities (* p*,

*,*q

*). Figures 3 and 4 show the corresponding, actual, quaternion components and the corresponding angular velocity components, where an approximate optimal linear feedback law based on Eq. (42) is used to track the reference trajectory.*r

In the next example, the simplified attitude dynamics is used with the gravity gradient torques neglected. This decouples the angular rate dynamics from the attitude quaternion dynamics, which need to be considered for synthesizing the reference trajectories. The reference angular velocities are then integrated to obtain the spacecraft’s quaternion attitude time history. Figure 5 shows the reference angular velocity components.

Figure 6 shows the errors in the actual angular velocity components when compared with corresponding reference values and Figure 7 the corresponding quaternion components. Figure 8 shows the attitude in terms of the Euler axis and the Euler principal angle components.

In the final example it is desired to alter the attitude quaternion of the spacecraft, so as to point the spacecraft in a desired direction. In this case on the quaternion kinematics defined by Eq. (44) are used. The maximum angular velocity of the spacecraft is assumed to be limited to 0.001 rad/s. The desired pointing direction is specified as a yaw, roll pitch Euler angle sequence given by

In Figure 9 are shown the reference optimal quaternion components and in Figure 10 are shown the corresponding angular velocity components. The optimum torque components required to affect the attitude change are shown in Figure 11. These include compensation for the gravity gradient torques. They show that they could be easily achieved by low thrust electric actuators such as electro-spray thrusters.

When small reaction wheels are used Eq. (19) may be modified to include the momentum of the wheels and the control inputs to the wheels could also be estimated. If reaction wheels are used much larger torques are possible and the time over which they are used could be shortened. In Figure 12 are shown the attitude time history components in terms of the Euler axis and Euler principal angle components.

This example is also solved using the shape based approach discussed briefly in Section 7. In Figure 13 are shown the required applied torque components obtained by the shape based approach with

## 9. Discussion and conclusions

A close examination of the results in Figures 9 and 12 shows that while the quaternion component time histories are not linearly varying, the Euler axis and Euler principal angle components are almost linear. This allows for linear extrapolation of the trajectories if when desired. It is also observed that the acquisition of the Euler axis is relative fast in comparison with growth rate of the Euler angle which is relatively slower. The kinematics of the Euler axis seems to represent a fast sub-system while the growth of the Euler angle represents the slow sub-system. This observation, facilitates the construction of approximate sub-optimal trajectories where in the Euler axis is acquired instantly and the Euler angle increases or decreases linearly with time. Once a sub-optimal solution can be defined in terms of interpolating polynomial it can also be further optimized by using Eq. (13) and shape based methods as those proposed by Caubet and Biggs [18, 19], quite rapidly and if need be, by the pseudo spectral method, or other direct collocation methods. The advantage of further optimization using shape based methods is that the precise shape of the desired output could be achieved avoiding overshoot. However depending on the choice of the output shape function, the control could be restrictive and so the magnitudes of the torques required could be much larger in comparison with the co-states approach.

For the preceding example, where a set angular velocity components were desired, the velocity components and the corresponding quaternion components are shown in Figures 5, 6, 7 as they vary with time. Figure 8 also shows that the Euler axis and Euler principal angle components are varying as quadratic functions of time. A similar conclusion cannot be drawn as far as the angular velocity components and the components of the quaternion. This again is extremely useful in applying low order polynomials for developing formulae for extrapolating the optimal trajectories, by converting the quaternion components to the domain of the Euler axis and Euler principal angle components. It also facilitates the integration of various optimal segments into a single trajectory over an extended time frame.

From the first example, comparing Figures 1 and 2 with Figures 3 and 4, it is seen that the optimum tracking feedback control law obtained by linearly approximating the relationship between the states and co-states by Eq. (40), performs well. The errors between these two sets of trajectories, the reference trajectory and the actual tracked trajectory, are always within 5% of the corresponding reference value, over the time frame of the plots.

In this paper, either the simplest form of the attitude dynamics or the basic kinematic equations alone are used to construct the optimal trajectories. The required control torques are obtained from the inverse dynamic relations. The usefulness of transforming the attitude representation to the Euler axis and Euler principal angle components, as it facilitates the application of low order polynomials for the construction of approximate sub-optimal trajectories, is demonstrated. Furthermore it is shown how optimal feedback control laws may be constructed from the solution for the optimal trajectories, for tracking the reference trajectories.

## References

- 1.
Lee B-H, Lee B-U, Oh H-S, Lee S-H, Rhee S-E. Time optimal attitude maneuver strategies for the agile spacecraft with reaction wheels and thrusters. Journal of Mechanical Science and Technology. 2005; 19 (9):1695-1705 - 2.
Yoshida K, Dimitrov D, Nakanishi H. On the capture of tumbling satellite by a space robot. In: IEE/RSJ International Conference on Intelligent Robots and Systems; 2006. pp. 4127-4132 - 3.
Aghili F. Optimal control for robotic capturing and passivation of a tumbling satellite, AIAA Guidance, Navigation and Control Conference. In: AIAA Guidance, Navigation and Control Conference and Exhibit; Aug., 2008; Honolulu, Hawaii; pp. 18–21 AIAA 2008-7274, DOI: 10.2514/6.2008-7274 - 4.
Aghili F. Time-optimal de-tumbling control of spacecraft. Journal of Guidance, Control, and Dynamics. 2009; 32 (5):1671-1675 - 5.
Yang CC, Wu CJ. Time-optimal de-tumbling control of a rigid spacecraft. Journal of Vibration and Control. 2008; 14 (4):553-570. DOI: 10.1177/1077546307080034 - 6.
Liu HY, Wang HN, Chen ZM. De-tumbling controller and attitude acquisition for micro-satellite based on magnetic torque. Journal of Astronautics. 2007; 28 (2):333-337 - 7.
Zhang L, Yu C, Zhang S, Cai H. Optimal attitude trajectory planning method for CMG actuated spacecraft. Proceedings of the Institution of Mechanical Engineers, Part G: Journal of Aerospace Engineering. 2016; 232 (1):131-142 - 8.
Sharma R, Tewari A. Optimal nonlinear tracking of spacecraft attitude maneuvers. IEEE Transactions on Control Systems Technology. 2004; 12 (5):677-682. DOI: 10.1109/TCST.2004.825060 - 9.
Hegrenas O, Gravdahl JT, Tondel P. Attitude control by means of explicit model predictive control, via multi-parametric quadratic programming. In: Proceedings of American Control Conference; Piscataway, NJ: IEEE; 2005. pp. 901-906 - 10.
Lobo K, Lang J, Starks A, Sands T. Analysis of deterministic artificial intelligence for inertia modifications and orbital disturbance. International Journal of Control Science and Engineering. 2018; 8 (3):53-62 - 11.
Sands T, Kim JJ, Agrawal BN. Improved hamiltonian adaptive control of spacecraft. In: Proceedings of the IEEE Aerospace Conference; MT, USA: Big Sky; 2009. pp. 7-14 - 12.
Nakatani S, Sands T. Simulation of spacecraft damage tolerance and adaptive controls. In: Proceedings of the IEEE Aerospace Conference; MT, USA: Big Sky; 2014. pp. 1-8 - 13.
Baker K, Cooper M, Heidlauf P, Sands T. Autonomous trajectory generation for deterministic artificial intelligence. Electrical and Electronic Engineering. 2018; 8 (3):59-68 - 14.
Smeresky B, Rizzo A, Sands T. Kinematics in the information age. Mathematics. 2018; 6 (9):148 - 15.
Bryson AE Jr, Ho YC. Applied Optimal Control. Waltham, MA, USA: Ginn and Company; 1969 - 16.
Conway BA, editor. Spacecraft Trajectory Optimization. 1st ed. New York, NY, USA: Cambridge University Press; 2010 - 17.
Vepa R. Dynamics and Control of Autonomous Space Vehicles and Robotics. New York, NY, USA: Cambridge University Press; 2019 - 18.
Caubet A, Biggs JD. Optimal attitude motion planner for large slew maneuvers using a shape-based method. In: AIAA Guidance Navigation and Control Conference; Boston, USA; 2013. pp. 1-9. DOI 10.2514/6.2013–4719 - 19.
Caubet A, Biggs JD. An efficient sub-optimal motion planning method for attitude maneuvers. In: Proceedings AstroNet-II International Final Conference; Germany: Springer; 2016. pp. 31-46