arXiv Science⌕ Search

arXiv subjects

Hector Garcia de Marina

Publications and source records attributed to Hector Garcia de Marina.

At least 19 recordsLinked to original sources
arXiv2026

Singularity-Free Guiding Vector Fields on SO(3) with Designer-Specified Progression Behavior

This paper develops a singularity-free guiding vector field (SF-GVF) for path following on the special orthogonal group SO(3). First, we lift the Euclidean SF-GVF construction to SO(3), integrating the augmented-state approach with the intrinsic Lie-group geometry and obtaining a closed-form geometric guidance law whose integral curves converge to a designer-specified attitude path. The field is defined on a dense open subset of SO(3), excluding only the measure-zero antipodal set - a manifestation of the topological obstruction to continuous global stabilization on SO(3). The construction requires no per-step optimization and produces a control input intrinsically in so(3) as body angular rates. Second, we formalize the progression behavior along the path as a designer-supplied function ν(ξ), promoting the parametric speed from an implicitly resolved degree of freedom to a first-class design specification. In contrast to the Euclidean condition v = 0, which excludes vehicles with minimum-speed constraints, the corresponding condition ω= 0 on SO(3) is physically admissible for most platforms with active attitude control, making the progression behavior a design freedom structurally available on SO(3) but absent in the Euclidean setting. The framework's structural results are established under a bi-invariant Riemannian metric and hold uniformly across choices of path, progression, and Lyapunov gain. The framework is illustrated in simulation on self-intersecting paths under both constant and point-convergence progression behaviors.

cs.RO↗
arXiv2026

Fully distributed and resilient source seeking for robot swarms

Existing source-seeking algorithms for robot swarms typically require either direct gradient measurements or rigid geometric formations, limiting their flexibility and resilience to robot failures. We propose a fully distributed solution that overcomes these limitations by computing an ascending direction through local field measurements and distributed estimation of centroid-relative coordinates. The resulting architecture consists of three exponentially convergent algorithms operating in a slow-fast closed-loop system, enabling simultaneous estimation and motion control without central coordination. Our framework accommodates arbitrary swarm geometries and analyzes how the spatial distribution of robots affects gradient observability, robustness, and resilience to failures. We characterize optimal swarm shapes that guarantee alignment with the true gradient and show how shape morphing can maneuver the collective motion. The approach is developed for kinematic points in $\mathbb{R}^m$ and extended to 2D unicycles with constant speed. Simulations with large-scale swarms validate the methodology.

cs.RO↗
arXiv2026

Leaderless Collective Motion in Affine Formation Control over the Complex Plane

We propose a method for the collective maneuvering of affine formations in the plane by modifying the original weights of the Laplacian matrix used to achieve static formations of robot swarms. Specifically, the resulting collective motion is characterized as a time-varying affine transformation of a reference configuration, or shape. Unlike the traditional leader-follower strategy, our leaderless scheme allows agents to maintain distinct and possibly time-varying velocities, enabling a broader range of collective motions, including all the linear combinations of translations, rotations, scaling and shearing of a reference shape. Our analysis provides the analytic solution governing the resulting collective motion, explicitly designing the eigenvectors and eigenvalues that define this motion as a function of the modified weights in the new Laplacian matrix. To facilitate a more tractable analysis and design of affine formations in 2D, we propose the use of complex numbers to represent all relevant information. Simulations with up to 20 agents validate the theoretical results.

cs.RO↗
arXiv2025

Linear quadratic control for discrete-time systems with stochastic and bounded noises

This paper focuses on the linear quadratic control (LQC) design of systems corrupted by both stochastic noise and bounded noise simultaneously. When only of these noises are considered, the LQC strategy leads to stochastic or robust controllers, respectively. However, there is no LQC strategy that can simultaneously handle stochastic and bounded noises efficiently. This limits the scope where existing LQC strategies can be applied. In this work, we look into the LQC problem for discrete-time systems that have both stochastic and bounded noises in its dynamics. We develop a state estimation for such systems by efficiently combining a Kalman filter and an ellipsoid set-membership filter. The developed state estimation can recover the estimation optimality when the system is subject to both kinds of noise, the stochastic and the bounded. Upon the estimated state, we derive a robust state-feedback optimal control law for the LQC problem. The control law derivation takes into account both stochastic and bounded-state estimation errors, so as to avoid over-conservativeness while sustaining stability in the control. In this way, the developed LQC strategy extends the range of scenarios where LQC can be applied, especially those of real-world control systems with diverse sensing which are subject to different kinds of noise. We present numerical simulations, and the results demonstrate the enhanced control performance with the proposed strategy.

math.OC↗
arXiv2025

Dispersion Formation Control: from Geometry to Distribution

We introduce and develop the concept of dispersion formation control, bridging a gap between shape-assembly studies in physics and biology and formation control theory. In current formation control studies, the control objectives typically focus on achieving desired local geometric properties, such as inter-agent distances, bearings, or relative positions. In contrast, our dispersion formation control approach enables agents to directly regulate the dispersion of their spatial distribution, a global variable associated with a covariance matrix. Specifically, we introduce the notion of covariance similarity to define the target spatial dispersion of agents. Building on this framework, we propose two control strategies: a centralized approach to illustrate the key ideas, and a distributed approach that enables agents to control the global dispersion but using only local information. Our stability analysis demonstrates that both strategies ensure exponential convergence of the agents' distribution to the desired dispersion. Notably, controlling a global variable rather than multiple local ones enhances the resiliency of the system, particularly against malfunctioning agents. Simulations validate the effectiveness of the proposed dispersion formation control.

eess.SY↗
arXiv2025

Versatile Distributed Maneuvering with Generalized Formations using Guiding Vector Fields

This paper presents a unified approach to realize versatile distributed maneuvering with generalized formations. Specifically, we decompose the robots' maneuvers into two independent components, i.e., interception and enclosing, which are parameterized by two independent virtual coordinates. Treating these two virtual coordinates as dimensions of an abstract manifold, we derive the corresponding singularity-free guiding vector field (GVF), which, along with a distributed coordination mechanism based on the consensus theory, guides robots to achieve various motions (i.e., versatile maneuvering), including (a) formation tracking, (b) target enclosing, and (c) circumnavigation. Additional motion parameters can generate more complex cooperative robot motions. Based on GVFs, we design a controller for a nonholonomic robot model. Besides the theoretical results, extensive simulations and experiments are performed to validate the effectiveness of the approach.

cs.RO↗
arXiv2024

Source-Seeking Problem with Robot Swarms

We present an algorithm to solve the problem of locating the source, or maxima, of a scalar field using a robot swarm. We demonstrate how the robot swarm determines its direction of movement to approach the source using only field intensity measurements taken by each robot. In contrast with the current literature, our algorithm accommodates a generic (non-degenerate) geometry for the swarm's formation. Additionally, we rigorously show the effectiveness of the algorithm even when the dynamics of the robots are complex, such as a unicycle with constant speed. Not requiring a strict geometry for the swarm significantly enhances its resilience. For example, this allows the swarm to change its size and formation in the presence of obstacles or other real-world factors, including the loss or addition of individuals to the swarm on the fly. For clarity, the article begins by presenting the algorithm for robots with free dynamics. In the second part, we demonstrate the algorithm's effectiveness even considering non-holonomic dynamics for the robots, using the vector field guidance paradigm. Finally, we verify and validate our algorithm with various numerical simulations.

cs.RO↗
arXiv2024

Resilient source seeking with robot swarms

We present a solution for locating the source, or maximum, of an unknown scalar field using a swarm of mobile robots. Unlike relying on the traditional gradient information, the swarm determines an ascending direction to approach the source with arbitrary precision. The ascending direction is calculated from measurements of the field strength at the robot locations and their relative positions concerning the centroid. Rather than focusing on individual robots, we focus the analysis on the density of robots per unit area to guarantee a more resilient swarm, i.e., the functionality remains even if individuals go missing or are misplaced during the mission. We reinforce the robustness of the algorithm by providing sufficient conditions for the swarm shape so that the ascending direction is almost parallel to the gradient. The swarm can respond to an unexpected environment by morphing its shape and exploiting the existence of multiple ascending directions. Finally, we validate our approach numerically with hundreds of robots. The fact that a large number of robots always calculate an ascending direction compensates for the loss of individuals and mitigates issues arising from the actuator and sensor noises.

cs.RO↗
arXiv2023

Scaling up the formation of agents with heterogeneous sensing: mixed distance and bearing-only

Unlike the case with identical neighboring agents whose actions are mirrored, the problem of distributed formation control design with heterogeneous sensing is not straightforward. In this paper, we consider the problem of distributed formation control where each agent can only control distances or bearings with its neighbors. We firstly develop a rigidity theory with heterogeneous sensing to ensure that the desired shape is well-posed. Secondly, we propose an iterative method that allows us to scale up the number of agents with heterogeneous sensing. Finally, numerical simulations show the effectiveness of our method.

eess.SY↗
arXiv2022

Guiding vector fields for the distributed motion coordination of mobile robots

We propose coordinating guiding vector fields to achieve two tasks simultaneously with a team of robots: first, the guidance and navigation of multiple robots to possibly different paths or surfaces typically embedded in 2D or 3D; second, their motion coordination while tracking their prescribed paths or surfaces. The motion coordination is defined by desired parametric displacements between robots on the path or surface. Such a desired displacement is achieved by controlling the virtual coordinates, which correspond to the path or surface's parameters, between guiding vector fields. Rigorous mathematical guarantees underpinned by dynamical systems theory and Lyapunov theory are provided for the effective distributed motion coordination and navigation of robots on paths or surfaces from all initial positions. As an example for practical robotic applications, we derive a control algorithm from the proposed coordinating guiding vector fields for a Dubins-car-like model with actuation saturation. Our proposed algorithm is distributed and scalable to an arbitrary number of robots. Furthermore, extensive illustrative simulations and fixed-wing aircraft outdoor experiments validate the effectiveness and robustness of our algorithm.

cs.RO↗
arXiv2021

Singularity-free Guiding Vector Field for Robot Navigation

Most of the existing path-following navigation algorithms cannot guarantee global convergence to desired paths or enable following self-intersected desired paths due to the existence of singular points where navigation algorithms return unreliable or even no solutions. One typical example arises in vector-field guided path-following (VF-PF) navigation algorithms. These algorithms are based on a vector field, and the singular points are exactly where the vector field diminishes. In this paper, we show that it is mathematically impossible for conventional VF-PF algorithms to achieve global convergence to desired paths that are self-intersected or even just simple closed (precisely, homeomorphic to the unit circle). Motivated by this new impossibility result, we propose a novel method to transform self-intersected or simple closed desired paths to non-self-intersected and unbounded (precisely, homeomorphic to the real line) counterparts in a higher-dimensional space. Corresponding to this new desired path, we construct a singularity-free guiding vector field on a higher-dimensional space. The integral curves of this new guiding vector field is thus exploited to enable global convergence to the higher-dimensional desired path, and therefore the projection of the integral curves on a lower-dimensional subspace converge to the physical (lower-dimensional) desired path. Rigorous theoretical analysis is carried out for the theoretical results using dynamical systems theory. In addition, we show both by theoretical analysis and numerical simulations that our proposed method is an extension combining conventional VF-PF algorithms and trajectory tracking algorithms. Finally, to show the practical value of our proposed approach for complex engineering systems, we conduct outdoor experiments with a fixed-wing airplane in windy environment to follow both 2D and 3D desired paths.

cs.RO↗
arXiv2021

Distributed formation control for manipulator end-effectors

We present three classes of distributed formation controllers for achieving and maintaining the 2D/3D formation shape of manipulator end-effectors to cope with different scenarios due to availability of modeling parameters. We firstly present a distributed formation controller for manipulators whose system parameters are perfectly known. The formation control objective is achieved by assigning virtual springs between end-effectors and by adding damping terms at joints, which provides a clear physical interpretation of the proposed solution. Subsequently, we extend it to the case where manipulator kinematic and system parameters are not exactly known. An extra integrator and an adaptive estimator are introduced for gravitational compensation and stabilization, respectively. Simulation results with planar manipulators and with seven degree-of-freedom humanoid manipulator arms are presented to illustrate the effectiveness of the proposed approach.

cs.RO↗
arXiv2021

Guiding vector fields in Paparazzi autopilot

This article is a technical report on the two different guidance systems based on vector fields that can be found in Paparazzi, a free sw/hw autopilot. Guiding vector fields allow autonomous vehicles to track paths described by the user mathematically. In particular, we allow two descriptions of the path with an implicit or a parametric function. Each description is associated with its corresponding guiding vector field algorithm. The implementations of the two algorithms are light enough to be run in a modern microcontroller. We will cover the basic theory on how they work, how a user can implement its own paths in Paparazzi, how to exploit them to coordinate multiple vehicles, and we finish with some experimental results. Although the presented implementation is focused on fixed-wing aircraft, the guidance is also applicable to other kinds of aerial vehicles such as rotorcraft.

cs.RO↗
arXiv2021

Distributed formation maneuver control by manipulating the complex Laplacian

This paper proposes a novel maneuvering technique for the complex-Laplacian-based formation control. We show how to modify the original weights that build the Laplacian such that a designed steady-state motion of the desired shape emerges from the local interactions among the agents. These collective motions can be exploited to solve problems such as the shaped consensus (the rendezvous with a particular shape), the enclosing of a target, or translations with controlled speed and heading to assist mobile robots in area coverage, escorting, and traveling missions, respectively. The designed steady-state collective motions correspond to rotations around the centroid, translations, and scalings of a reference shape. The proposed modification of the weights relocates one of the Laplacian's zero eigenvalues while preserving its associated eigenvector that constructs the desired shape. For example, such relocation on the imaginary or real axis induces rotational and scaling motions, respectively. We will show how to satisfy a sufficient condition to guarantee the global convergence to the desired shape and motions. Finally, we provide simulations and comparisons with other maneuvering techniques.

eess.SY↗
arXiv2021

Distributed coordinated path following using guiding vector fields

It is essential in many applications to impose a scalable coordinated motion control on a large group of mobile robots, which is efficient in tasks requiring repetitive execution, such as environmental monitoring. In this paper, we design a guiding vector field to guide multiple robots to follow possibly different desired paths while coordinating their motions. The vector field uses a path parameter as a virtual coordinate that is communicated among neighboring robots. Then, the virtual coordinate is utilized to control the relative parametric displacement between robots along the paths. This enables us to design a saturated control algorithm for a Dubins-car-like model. The algorithm is distributed, scalable, and applicable for any smooth paths in an $n$-dimensional configuration space, and global convergence is guaranteed. Simulations with up to fifty robots and outdoor experiments with fixed-wing aircraft validate the theoretical results.

cs.RO↗
arXiv2021

Leaderless collective motions in affine formation control

This paper proposes a novel distributed technique to induce collective motions in affine formation control. Instead of the traditional leader-follower strategy, we propose modifying the original weights that build the Laplacian matrix so that a designed steady-state motion of the desired shape emerges from the agents' local interactions. The proposed technique allows a rich collection of collective motions such as rotations around the centroid, translations, scalings, and shearings of a reference shape. These motions can be applied in useful collective behaviors such as \emph{shaped} consensus (the rendezvous with a particular shape), escorting one of the team agents, or area coverage. We prove the global stability and effectiveness of our proposed technique rigorously, and we provide some illustrative numerical simulations.

eess.SY↗
arXiv2021

Distributed formation control of manipulators' end-effector with internal model-based disturbance rejection

This paper addresses the problem of end-effector formation control for manipulators that are subjected to external disturbances: input disturbance torques and disturbance forces at each end-effector. The disturbances are assumed to be non-vanishing and are superposition of finite number of sinusoidal and step signals. The formation control objective is achieved by assigning virtual springs between end-effectors, by adding damping terms at joints, and by incorporating internal model-based dynamic compensators to counteract the effect of the disturbances; all of which presents a clear physical interpretation of the proposed approach. Simulation results are presented to illustrate the effectiveness of the proposed approach.

cs.RO↗