N. Harris McClamroch

Taeyoung Lee, Melvin Leok, N. Harris McClamroch

This paper provides new results for control of complex flight maneuvers for a quadrotor unmanned aerial vehicle (UAV). The flight maneuvers are defined by a concatenation of flight modes or primitives, each of which is achieved by a nonlinear controller that solves an output tracking problem. A mathematical model of the quadrotor UAV rigid body dynamics, defined on the configuration space $\SE$, is introduced as a basis for the analysis. The quadrotor UAV has four input degrees of freedom, namely the magnitudes of the four rotor thrusts; each flight mode is defined by solving an asymptotic optimal tracking problem. Although many flight modes can be studied, we focus on three output tracking problems, namely (1) outputs given by the vehicle attitude, (2) outputs given by the three position variables for the vehicle center of mass, and (3) output given by the three velocity variables for the vehicle center of mass. A nonlinear tracking controller is developed on the special Euclidean group $\SE$ for each flight mode, and the closed loop is shown to have desirable closed loop properties that are almost global in each case. Several numerical examples, including one example in which the quadrotor recovers from being initially upside down and another example that includes switching and transitions between different flight modes, illustrate the versatility and generality of the proposed approach.

Taeyoung Lee, Melvin Leok, N. Harris McClamroch

This paper presents an analytical model and a geometric numerical integrator for a system of rigid bodies connected by ball joints, immersed in an irrotational and incompressible fluid. The rigid bodies can translate and rotate in three-dimensional space, and each joint has three rotational degrees of freedom. This model characterizes the qualitative behavior of three-dimensional fish locomotion. A geometric numerical integrator, refereed to as a Lie group variational integrator, preserves Hamiltonian structures of the presented model and its Lie group configuration manifold. These properties are illustrated by a numerical simulation for a system of three connected rigid bodies.

Taeyoung Lee, Melvin Leok, N. Harris McClamroch

Euler-Lagrange equations and variational integrators are developed for Lagrangian mechanical systems evolving on a product of two-spheres. The geometric structure of a product of two-spheres is carefully considered in order to obtain global equations of motion. Both continuous equations of motion and variational integrators completely avoid the singularities and complexities introduced by local parameterizations or explicit constraints. We derive global expressions for the Euler-Lagrange equations on two-spheres which are more compact than existing equations written in terms of angles. Since the variational integrators are derived from Hamilton's principle, they preserve the geometric features of the dynamics such as symplecticity, momentum maps, or total energy, as well as the structure of the configuration manifold. Computational properties of the variational integrators are illustrated for several mechanical systems.

Taeyoung Lee, Melvin Leok, N. Harris McClamroch

This paper provides nonlinear tracking control systems for a quadrotor unmanned aerial vehicle (UAV) that are robust to bounded uncertainties. A mathematical model of a quadrotor UAV is defined on the special Euclidean group, and nonlinear output-tracking controllers are developed to follow (1) an attitude command, and (2) a position command for the vehicle center of mass. The controlled system has the desirable properties that the tracking errors are uniformly ultimately bounded, and the size of the ultimate bound can be arbitrarily reduced by control system parameters. Numerical examples illustrating complex maneuvers are provided.

Taeyoung Lee, Melvin Leok, N. Harris McClamroch

This paper presents an analytical model and a geometric numerical integrator for a rigid body connected to an elastic string, acting under a gravitational potential. Since the point where the string is attached to the rigid body is displaced from the center of mass of the rigid body, there exist nonlinear coupling effects between the string deformation and the rigid body dynamics. A geometric numerical integrator, refereed to as a Lie group variational integrator, is developed to numerically preserve the Hamiltonian structure of the presented model and its Lie group configuration manifold. These properties are illustrated by a numerical simulation.

Eugene G. Fahnestock, Taeyoung Lee, Melvin Leok et al.

We present a combination of tools which allows for investigation of the coupled orbital and rotational dynamics of two rigid bodies with nearly arbitrary shape and mass distribution, under the influence of their mutual gravitational potential. Methods for calculating that mutual potential and resulting forces and moments for a polyhedral body representation are simple and efficient. Discrete equations of motion, referred to as the Lie Group Variational Integrator (LGVI), preserve the structure of the configuration space, SE(3), as well as the geometric features represented by the total energy and the total angular momentum. The synthesis of these approaches allows us to simulate the full two body problem accurately and efficiently. Simulation results are given for two octahedral rigid bodies for comparison with other integration methods and to show the qualities of the results thus obtained. A significant improvement is seen over other integration methods while correctly capturing the interesting effects of strong orbit and attitude dynamics coupling, in multiple scenarios.

Taeyoung Lee, Melvin Leok, N. Harris McClamroch

We develop the equations of motion for full body models that describe the dynamics of rigid bodies, acting under their mutual gravity. The equations are derived using a variational approach where variations are defined on the Lie group of rigid body configurations. Both continuous equations of motion and variational integrators are developed in Lagrangian and Hamiltonian forms, and the reduction from the inertial frame to a relative coordinate system is also carried out. The Lie group variational integrators are shown to be symplectic, to preserve conserved quantities, and to guarantee exact evolution on the configuration space. One of these variational integrators is used to simulate the dynamics of two rigid dumbbell bodies.