A Separation Principle on Lie Groups

For linear time-invariant systems, a separation principle holds: stable observer and stable state feedback can be designed for the time-invariant system, and the combined observer and feedback will be stable. For non-linear systems, a local separation principle holds around steady-states, as the linearized system is time-invariant. This paper addresses the issue of a non-linear separation principle on Lie groups. For invariant systems on Lie groups, we prove there exists a large set of (time-varying) trajectories around which the linearized observer-controler system is time-invariant, as soon as a symmetry-preserving observer is used. Thus a separation principle holds around those trajectories. The theory is illustrated by a mobile robot example, and the developed ideas are then extended to a class of Lagrangian mechanical systems on Lie groups described by Euler-Poincare equations.Comment: Submitted to IFAC 201

Gradient-like observer design on the Special Euclidean group SE(3) with system outputs on the real projective space

A nonlinear observer on the Special Euclidean group $\mathrm{SE(3)}$ for full pose estimation, that takes the system outputs on the real projective space directly as inputs, is proposed. The observer derivation is based on a recent advanced theory on nonlinear observer design. A key advantage with respect to existing pose observers on $\mathrm{SE(3)}$ is that we can now incorporate in a unique observer different types of measurements such as vectorial measurements of known inertial vectors and position measurements of known feature points. The proposed observer is extended allowing for the compensation of unknown constant bias present in the velocity measurements. Rigorous stability analyses are equally provided. Excellent performance of the proposed observers are shown by means of simulations

Integral Control on Lie Groups

In this paper, we extend the popular integral control technique to systems evolving on Lie groups. More explicitly, we provide an alternative definition of "integral action" for proportional(-derivative)-controlled systems whose configuration evolves on a nonlinear space, where configuration errors cannot be simply added up to compute a definite integral. We then prove that the proposed integral control allows to cancel the drift induced by a constant bias in both first order (velocity) and second order (torque) control inputs for fully actuated systems evolving on abstract Lie groups. We illustrate the approach by 3-dimensional motion control applications.Comment: Resubmitted to Systems and Control Letters, February 201

Abstraction and Control for Groups of Robots

This paper addresses the general problem of controlling a large number of robots required to move as a group. We propose an abstraction based on the definition of a map from the configuration space Q of the robots to a lower dimensional manifold A, whose dimension is independent of the number of robots. In this paper, we focus on planar fully actuated robots. We require that the manifold has a product structure A = G x S, where G is a Lie group, which captures the position and orientation of the ensemble in the chosen world coordinate frame, and S is a shape manifold, which is an intrinsic characterization of the team describing the “shape” as the area spanned by the robots. We design decoupled controllers for the group and shape variables. We derive controllers for individual robots that guarantee the desired behavior on A. These controllers can be realized by feedback that depends only on the current state of the robot and the state of the manifold A. This has the practical advantage of reducing the communication and sensing that is required and limiting the complexity of individual robot controllers, even for large numbers of robots