Effective trajectory planning and cooperative control of multi-agent systems require accurate localization of the agents to preform collaborative missions. Accurate localization may be achieved by Global Positioning System (GPS) and simultaneous localization and mapping. However, GPS signals and fixed features may not be readily available, particularly in remote and unstructured environments. Under these circumstances, Cooperative Localization (CL) has been proposed as a short-term solution that can significantly improve vehicle pose estimation. CL algorithms have been developed and tested mainly on mobile robots and planar vehicles due to complexities of three-dimensional (3D) motion. In this paper, we present a CL algorithm for multi-agent systems comprised of 3D vehicles. Each vehicle's pose is represented by three position and three orientation variables. Quaternions are employed to represent orientation and avoid singularities associated with Euler angle. Vehicle kinematic velocity relations are used to model vehicle dynamics with respect to a fixed reference frame. It is assumed a vehicle can take relative pose measurements of other neighboring vehicles within an ad hoc network of agents. We then designate the observed as target vehicles and the observers as base vehicles and determine the linearized output matrix of the relative measurements for Extended Kalman Filter (EKF) application. Simulations are presented to discuss the advantages and shortcomings of the algorithm.


Cooperative Localization of Vehicles in Three-Dimensional Space

Division / Sponsors: 
Dynamic Systems & Control (DSCD)

Paper Proceedings: https://asmedigitalcollection.asme.org/DSCC/DSCC2020/volume/84270

DSCC2020 - Virtual Conference

Supporting the need among researchers worldwide for additional online and multimedia content, ASME now offers the ASME Conference Video Collection. This platform will collect and provide long-term access to conference presentation videos, encompassing all technology areas within ASME's technical conference and events program. About 30,000-40,000 engineers across all mechanical engineering and related disciplines participate in ASME conferences each year. This includes authors of approximately 6,000 to 8,000 technical papers published by ASME, the majority of whom also submit video presentations for our virtual conferences. The video collection will be available as an add-on to existing product packages or as a separate subscription.