A Multi-Vehicle Cooperative Localization Approach for an Autonomy Framework

Abstract

Offensive techniques produced by technological advancement present opportunities for adversaries to threaten the operational advantages of our joint and allied forces. Combating these new methodologies requires continuous and rapid development towards our own set of \game-changing technologies. Through focused development of unmanned systems and autonomy, the Air Force can strive to maintain its technological superiority. Furthermore, creating a robust framework capable of testing and evaluating the principles that define autonomy allows for the exploration of future capabilities. This research presents development towards a hybrid reactive/deliberative architecture that will allow for the testing of the principles of task, cognitive, and peer flexibility. Specifically, this work explores peer flexibility in multi-robot systems to solve a localization problem using the Hybrid Architecture for Multiple Robots (HAMR) as a basis for the framework. To achieve this task a combination of vehicle perception and navigation tools formulate inferences on an operating environment. These inferences are then used for the construction of Factor Graphs upon which the core algorithm for localization implements iSAM2, a high performing incremental matrix factorization method. A key component for individual vehicle control within the framework is the Unified Behavior Framework (UBF), a behavior-based control architecture which uses modular arbitration techniques to generate actions that enable actuator control. Additionally, compartmentalization of a World Model is explored through the use of containers to minimize communication overhead and streamline state information. The design for this platform takes on a polymorphic approach for modularity and robustness enabling future development