A main problem in autonomous vehicles in general, and in unmanned aerial vehicles (UAVs) in particular, is the determination of the attitude angles. A novel method to estimate these angles using off-the-shelf components is presented. This paper introduces an attitude heading reference system (AHRS) based on the unscented Kalman filter (UKF) using the three-axis attitude determination (TRIAD) algorithm as the observation model. The performance of the method is assessed through simulations and compared to an AHRS based on the extended Kalman filter (EKF). The paper presents field experiment results using a real fixed-wing UAV. The results show good real-time performance with low computational cost in a microcontroller.
Recently, it has been reported that inconsistent range-measurement or, equivalently, mismatches in prescribed interagent distances, may prevent popular gradient controllers from guiding rigid formations of mobile agents to converge to their desired shape and, even worse, from standing still at any location. In this paper, instead of treating mismatches as the source of poor performance, we take them as design parameters and show that by introducing such a pair of parameters per distance constraint, distributed controller achieving simultaneously both formation and motion control can be designed that not only encompasses the popular gradient control, but more importantly allows us to achieve constant collective translation, rotation, or their combination, while guaranteeing asymptotically that no distortion in the formation shape occurs. Such motion control results are then applied to 1) the alignment of formations' orientations and 2) enclosing and tracking a moving target. Besides rigorous mathematical proof, experiments using mobile robots are demonstrated to show the satisfying performances of the proposed formation-motion distributed controller.
In robot navigation tasks, such as unmanned aerial vehicle (UAV) highway traffic monitoring, it is important for a mobile robot to follow a specified desired path. However, 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. Conventional VF-PF algorithms generate a vector field of the same dimensions as those of the space where the desired path lives. In this article, 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 nonself-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 2-D and 3-D desired paths.
Despite the great success of using gradient-based controllers to stabilize rigid formations of autonomous agents in the past years, surprising yet intriguing undesirable collective motions have been reported recently, when inconsistent measurements are used in the agents' local controllers. To make the existing gradient control robust against such measurement inconsistency, we exploit local estimators following the well-known internal model principle for robust output regulation control. The new estimator-based gradient control is still distributed in nature, and can be constructed systematically even when the number of agents in a rigid formation grows. We prove rigorously that the proposed control is able to guarantee exponential convergence, and then demonstrate through robotic experiments and computer simulations that the reported inconsistency-induced orbits of collective movements are effectively eliminated.
23 January 2018 in IEEE Transactions on Control Systems Technology
This paper discusses the problem of controlling formation shapes for a group of nonholonomic unicycle-type agents with constant speeds. The control input is designed to steer their orientations and the aim is to achieve a desired formation configuration for all the agents subject to constant-speed constraints. The circular motion center is adopted as a virtual position for each agent to define the desired formation shape. We consider several different formation design approaches based on different formation specifications under different interaction graphs. In particular, two different formation design approaches, namely, a displacement-based approach and a distance-based approach, are discussed in detail to coordinate constant-speed agents in achieving a desired formation shape with stable circular motions via limited interactions. The communication and measurement requirements for each approach are also discussed. Furthermore, we propose a combined controller to stabilize a formation shape and synchronize the heading of each agent simultaneously. The effectiveness of the proposed formation control schemes is validated by both numerical simulations and real experiments with actual unmanned fixed-wing aircraft.