Margarida Camarinha

Mishal Assif, Ravi Banavar, Anthony Bloch et al.

In this article we introduce a variational approach to collision avoidance of multiple agents evolving on a Riemannian manifold and derive necessary conditions for extremals. The problem consists of finding non-intersecting trajectories of a given number of agents, among a set of admissible curves, to reach a specified configuration, based on minimizing an energy functional that depends on the velocity, covariant acceleration and an artificial potential function used to prevent collision among the agents. The results are validated through numerical experiments on the manifolds $\mathbb{R}^{2}$ and $S^2$.

Anthony Bloch, Margarida Camarinha, Leonardo Colombo

We introduce variational obstacle avoidance problems on Riemannian manifolds and derive necessary conditions for the existence of their normal extremals. The problem consists of minimizing an energy functional depending on the velocity and covariant acceleration, among a set of admissible curves, and also depending on a navigation function used to avoid an obstacle on the workspace, a Riemannian manifold. We study two different scenarios, a general one on a Riemannian manifold and, a sub-Riemannian problem. By introducing a left-invariant metric on a Lie group, we also study the variational obstacle avoidance problem on a Lie group. We apply the results to the obstacle avoidance problem of a planar rigid body and an unicycle.

Anthony Bloch, Margarida Camarinha, Leonardo Colombo

This work is devoted to studying dynamic interpolation for obstacle avoidance. This is a problem that consists of minimizing a suitable energy functional among a set of admissible curves subject to some interpolation conditions. The given energy functional depends on velocity, covariant acceleration and on artificial potential functions used for avoiding obstacles. We derive first-order necessary conditions for optimality in the proposed problem; that is, given interpolation and boundary conditions we find the set of differential equations describing the evolution of a curve that satisfies the prescribed boundary values, interpolates the given points and is an extremal for the energy functional. We study the problem in different settings including a general one on a Riemannian manifold and a more specific one on a Lie group endowed with a left-invariant metric. We also consider a sub-Riemannian problem. We illustrate the results with examples of rigid bodies, both planar and spatial, and underactuated vehicles including a unicycle and an underactuated unmanned vehicle.