A Discrete Variational Integrator for Optimal Control Problems on SO(3)

In this paper we study a discrete variational optimal control problem for the rigid body. The cost to be minimized is the external torque applied to move the rigid body from an initial condition to a pre-specified terminal condition. Instead of discretizing the equations of motion, we use the discrete equations obtained from the discrete Lagrange--d'Alembert principle, a process that better approximates the equations of motion. Within the discrete-time setting, these two appr...

An efficient and accurate computational approach is proposed for optimal attitude control of a rigid body. The problem is formulated directly as a discrete time optimization problem using a Lie group variational integrator. Discrete necessary conditions for optimality are derived, and an efficient computational approach is proposed to solve the resulting two point boundary value problem. The use of geometrically exact computations on SO(3) guarantees that this optimal control...

In this article, a brief description of Discrete Mechanics and Variational Integrators which preserve the symplectic structure of the flow will be provided and a Newton-Raphson algorithm that can be used to solve implicit equations on the SO(3) manifold will be developed. These techniques will be used to simulate the rotational dynamics of a rigid body evolving on the Lie Group SO(3).

This paper develops numerical methods for optimal control of mechanical systems in the Lagrangian setting. It extends the theory of discrete mechanics to enable the solutions of optimal control problems through the discretization of variational principles. The key point is to solve the optimal control problem as a variational integrator of a specially constructed higher-dimensional system. The developed framework applies to systems on tangent bundles, Lie groups, underactuate...

This paper formulates optimal control problems for rigid bodies in a geometric manner and it presents computational procedures based on this geometric formulation for numerically solving these optimal control problems. The dynamics of each rigid body is viewed as evolving on a configuration manifold that is a Lie group. Discrete-time dynamics of each rigid body are developed that evolve on the configuration manifold according to a discrete version of Hamilton's principle so t...

A time optimal attitude control problem is studied for the dynamics of a rigid body. The objective is to minimize the time to rotate the rigid body to a desired attitude and angular velocity while subject to constraints on the control input. Necessary conditions for optimality are developed directly on the special orthogonal group using rotation matrices. They completely avoid singularities associated with local parameterizations such as Euler angles, and they are expressed a...

In this paper we will discuss some new developments in the design of numerical methods for optimal control problems of Lagrangian systems on Lie groups. We will construct these geometric integrators using discrete variational calculus on Lie groups, deriving a discrete version of the second-order Euler-Lagrange equations. Interesting applications as, for instance, a discrete derivation of the Euler-Poincar\'e equations for second-order Lagrangians and its application to optim...

This article solves an optimal control problem arising in attitude control of a spacecraft under state and control constraints. We first derive the discrete-time attitude dynamics by employing discrete mechanics. The orientation transfer, with initial and final values of the orientation and momentum and the time duration being specified, is posed as an energy optimal control problem in discrete-time subject to momentum and control constraints. Using variational analysis direc...

Optimal control problems are formulated and efficient computational procedures are proposed for combined orbital and rotational maneuvers of a rigid body in three dimensions. The rigid body is assumed to act under the influence of forces and moments that arise from a potential and from control forces and moments. The key features of this paper are its use of computational procedures that are guaranteed to preserve the geometry of the optimal solutions. The theoretical basis f...

Classical mathematical techniques such as discrete integration, gradient descent optimization, and state estimation (exemplified by the Runge-Kutta method, Gauss-Newton minimization, and extended Kalman filter or EKF, respectively), rely on linear algebra and hence are only applicable to state vectors belonging to Euclidean spaces when implemented as described in the literature. This document discusses how to modify these methods so they can be applied to non-Euclidean state ...