Analysis of the Unscented Transform for Cooperative Localization with only Inter-vehicle Ranging Information

Uthman Olawoye, Cagri Kilic, Jason N. Gross · 2025

Read Analysis of the Unscented Transform for Cooperative Localization with only Inter-vehicle Ranging Information by Uthman Olawoye, Cagri Kilic, Jason N. Gross (2025) in the Tower of Babel, a free online library of public-domain works preserved in clean, searchable text. No sign-up. The full text is served as a plain-text file at a predictable URL, where text is present: https://antarctic-labs.com/tower-of-babel/arxiv-2504-07242.txt.

Introduction

Uthman Olawoye, Cagri Kilic, and Jason Gross asked how robots can find their place as a group, in a 2025 paper. Each robot knows only the range to the others nearby, not its own fixed spot. Noise, curved math, and links between the robots' own guesses make the task hard.

They test a method that spreads a set of sample points through the math to handle spread and error. To merge what each robot thinks, without knowing how their errors link, they use a second method that fuses full guesses. That merge forces some reuse of the same data, which can bias results. Their study weighs how well the combined method holds up as noise and error change.

Catalog record

CREATORUthman Olawoye, Cagri Kilic, Jason N. Gross
YEAR2025
COLLECTIONPAPERS
FORMATTXT
FILE SIZE38 KB
VERSION1.0
LICENSEhttp://creativecommons.org/licenses/by/4.0/
RIGHTSCC BY
SOURCEarXiv

Source: https://arxiv.org/abs/2504-07242

Browse the full library · About the Tower of Babel

Full text

The opening of the work, from the library's hosted text:

Analysis of the Unscented Transform for Cooperative Localization with only Inter-vehicle Ranging Information Uthman Olawoye, Cagri Kilic, Jason N. Gross Abstract Cooperative localization in multi-agent robotic systems is challenging, especially when agents rely on limited information, such as only peer-to-peer range measurements. Two key challenges arise: utilizing this limited information to improve position estimation; handling uncertainties from sensor noise, nonlinearity, and unknown correlations between agents’ measurements; and avoiding information reuse. This paper examines the use of the Unscented Transform (UT) for state estimation for a case in which range measurement between agents and covariance intersection (CI) is used to handle unknown correlations. Unlike Kalman Filter approaches, CI methods fuse complete state and covariance estimates. This makes formulating a CI approach with ranging-only measurements a challenge. To overcome this, UT is used to handle uncertainties and formulate a cooperative state update using range measurements and current cooperative state estimates. This introduces information reuse in the measurement update. Therefore, this work aims to evaluate the limitations and utility of this formulation when faced with various levels of state measurement uncertainty and errors. I Introduction Cooperative localization has emerged as a viable strategy for increasing the accuracy and resilience of multi-robot systems’ localization [ 1 ] . Cooperative localization provides a more reliable estimation of each robot’s position by combining relative measurements across robots and merging sensor data from different sources [ 2 ] . Yet, coordination and collaboration can become difficult given the increasing processing and communication costs in large groups of multi-robot and swarm robotic systems [ 3 ] . Several mobile robot tasks, such as exploration, navigation, object identification and tracking, and map construction, require an accurate localization estimate. By leveraging relative measurements amongst robots and exchanging their state estimations and covariances [ 4 ] , cooperative localization improves localization performance significantly when using minimal sensors onboard [ 5 ] . Cooperative localization in multi-robot systems can be divided into centralized and decentralized techniques. Decentralized techniques, in particular, have become more common because of their lower computing and communication costs and their resistance to failure, though they tend to be less optimal in some aspects. [ 6 , 7 ] . For example, individual state estimations are often produced by combining proprioceptive and exteroceptive sensor readings. Nevertheless, GNSS coverage is restricted in urban and forested regions, resulting in poor localization performance in these conditions [ 8 ] . In this respect, if some robots in the system are in an area where the GNSS signal is disrupted, others having GNSS access can exchange this information during relative updates [ 9 ] . The decentralized architecture of the filter estimator also allows the robots to decouple their individual states to reduce computational costs. Moreover, the robots are equipped with UWB sensors that allow them to perform relative ranging measurement updates with other robots within a specified proximity [ 5 ] . This is done by coupling the states and covariances of the robots participating in the update. When robots estimate poses independently, correlations between them are often lost, leading to inconsistent results in traditional methods like the Kalman filter. One solution is to avoid reusing information multiple times. Some methods have robots compute local estimates from their sensors and fuse them with other agents’ data. Only the local estimate is shared to minimize correlation issues [ 10 ] . Another approach [ 11 ] uses the CI Filter, which assumes full dependence between measurements and state vectors, acting as a conservative version of the Kalman filter. The Split Covariance Intersection Filter (SCIF) refines this by managing dependency configurations for more accurate estimations [ 12 , 13 ] . Other methods use pose measurements via LiDAR [ 14 , 15 , 16 ] or cameras [ 17 ] , but these require extensive data processing. Low-cost Ultra-Wideband (UWB) sensors can provide relative ranging with centimeter precision [ 18 ] . Range-only data, while useful, leads to non-linear functions that are difficult for fusion. Ranging-only cooperative localization has been widely studied [ 19 , 20 , 21 , 22 , 23 , 24 ] , often relying on multiple UWB sensors for inter-agent distance measurements and techniques like triangulation. Fixed anchors are usually required to act as reference points, but dynamic agents can also serve as temporary anchors. However, reliance on range-only data introduces cumulative errors over time, and the Kalman Filter struggles with its nonlinearity and unknown sensor correlations. Traditional approaches requiring UWB-ranging infrastructure face limitations in dynamic environments where static anchors may not be feasible. These issues are compounded by potential information reuse, which distorts accuracy. Our approach leverages the UT for state estimation and CI for data fusion to enable cooperative localization in ranging-only scenarios. The primary objective of this work is to rigorously assess the applicability and limitations of the UT in conjunction with CI for cooperative localization, particularly in situations where agents rely solely on range measurements between robots. By employing UT, we aim to manage uncertainties effectively and perform cooperative state updates that leverage range data and existing cooperative state estimates. The rest of this paper is organized as follows. Section II defines the problem and introduces the notations, state representations, and mathematical equations. Section III details and explains the components of the methodology. Section IV provides the initial test setup. Finally, Section V and VI present the expected results, contributions, and insights for future work to improve the system. II Problem Statement In this paper, we consider a multivehicle localization scenario inspired by [ 25 ] involving two robotic agents, denoted as \mathbf{A_{1}} and \mathbf{A_{2}} , operating in a 2D environment. Let the state vectors be defined as the state of \mathbf{A_{1}} and \mathbf{A_{2}} at time step k and represented as: \mathbf{x}_{1}^{k}=\begin{bmatrix}x_{1}^{k}&y_{1}^{k}&v_{x_{1}}^{k}&v_{y_{1}}^{k}\end{bmatrix}^{\top},\mathbf{x}_{2}^{k}=\begin{bmatrix}x_{2}^{k}&y_{2}^{k}&v_{x_{2}}^{k}&v_{y_{2}}^{k}\end{bmatrix}^{\top} (1) where x^{k} , y^{k} , v_{x}^{k} and v_{y}^{k} denote the position and velocity of the respective vehicles at time step k . where the numbered subscripts denote the robots. The robots are assumed to be point masses; thus, only the position is estimated, i.e., no orientation. The corresponding covariance matrices of their states are given by \mathbf{P}_{1}^{k} and \mathbf{P}_{2}^{k} . The inter-vehicle range measurement at time step k is: r^{k}=\|\mathbf{x}_{1}^{k}-\mathbf{x}_{2}^{k}\|+u (2) where u\sim\mathcal{N}(0,R) represents zero-mean Gaussian noise with variance R . The objective is to estimate the state of \mathbf{A_{2}} , \mathbf{x}_{2}^{k} and minimize the localization uncertainty, given: • Reliable Positioning updates for \mathbf{A_{1}} : \mathbf{y}_{1}^{k}=\mathbf{x}_{1}^{k}+\mathbf{w}_{1},\quad\mathbf{w}_{1}\sim\mathcal{N}(0,\mathbf{Q}_{1}) (3) where \mathbf{y}_{1}^{k} is the positioning measurement and \mathbf{Q}_{1} is the covariance of the position solution uncertainty. • Sporadic and noisy Positioning updates for \mathbf{A_{2}} : \mathbf{y}_{2}^{k}=\mathbf{x}_{2}^{k}+\mathbf{w}_{2},\quad\mathbf{w}_{2}\sim\mathcal{N}(0,\mathbf{Q}_{2}) (4) where \mathbf{Q}_{2} is the covariance of \mathbf{A_{2}} ’s position solution uncertainty. • Inter-vehicle range measurements, r^{k} , which are nonlinear functions of the vehicle states. r_{1} r_{2} r_{3} r_{4} \mathbf{A_{1}} \mathbf{A_{2}} Fig. 1 : Two-Robot Localization Scenario with Inter-Vehicle Range Measurements III Methodology The main objective, as defined above, is to improve the accuracy of state estimation using limited communication data. Specifically, range measurements and state estimates are shared between agents. The proposed method is evaluated using a 2D simulation of a toy example involving two robots: Robot \mathbf{A_{1}} gets reliable and frequent absolute positioning updates, and Robot \mathbf{A_{2}} , whose state is more uncertain due to sporadic and

Read the complete text