Abstract:Estimating the state (i.e., determining the position and orientation) of a rigid body (RB) is a key enabler technology for many applications (e.g., vehicle motion control and autonomous driving). Thus, rigid body localization (RBL), which can obtain both positions and poses of RBs, has drawn great attention recently. Most existing RBL methods mainly focus on estimating a single RB's state. However, the multi-agent scenario, which can be found in many applications like vehicleto-vehicle communication, has not been explicitly accounted for. Moreover, these methods undergo significant performance degradation when the communication conditions between sensors and anchors are poor. In this work, we propose a cooperative rigid body localization (CRBL) framework, which additionally leverages the interactions among RBs to achieve accurate and robust state estimation of multiple RBs. To this end, we need to figure out two key questions: 1) how to assess the attainable performance of CRBL; 2) how to use the newly introduced measurements among RBs to enhance the estimation performance. To answer the two questions, we first perform the CramerRao lower bound (CRLB) analysis for the CRBL framework to characterize the performance improvement. Theoretical analysis shows that CRBL has a lower error bound than the conventional RBL framework. Furthermore, we propose two efficient CRBL algorithms. The first one is a lightweight method based on the weighted least squares, named WLS-CRBL, which is an optimal algorithm over the small noise region and is computationally efficient. The second one is implemented by the semi-definite relaxation (SDR) technique named SDR-CRBL, aiming to achieve robust estimation when the noise is high. Numerical experiments show that the proposed methods can achieve their theoretical performance and outperform the conventional RBL algorithms, especially in the case of poor communications between sensors and anchors.

PCRLB for batch discrete‐time estimation through state decoupling

Online Estimation of the Approximate Posterior Cramer-Rao Lower Bound for Discrete-Time Nonlinear Filtering

Barankin Bound for Bearing Estimation with Bias Correction

Posterior Cramer-Rao BoundsforState Estimation withQuantized Measurement

PCRLB for extended target tracking

Time-Optimal Constrained Adaptive Robust Control of Single-DOF Mechanical Systems: A Comparative Study with BLF-based Methods

Bayesian Cramer-Rao Lower Bounds for Prediction and Smoothing of Nonlinear TASD Systems

Bounded decoupling control for flexible‐joint robot manipulators with state estimation

Bearing-Only Target Tracking Using Cubature Rauch-Tung-Striebel Smoother

Performance Bounds Analysis for Hybrid Estimation

Posterior Cramer-Rao Bound for Inertial Sensors Enhanced Mobile Positioning under the Random Walk Motion Model

Recursive Joint Cramér-Rao Lower Bound for Parametric Systems with Two-Adjacent-states Dependent Measurements.

Towards Low‐complexity State Estimation for Rigid Bodies Based on Range Difference Measurements

Performance Bound For Extended Target Tracking Using High Resolution Sensors

The Estimation Fusion and Cramer-Rao Bounds for Nonlinear Systems with Uncertain Observations.

Towards Robust and Accurate Cooperative State Estimation for Multiple Rigid Bodies

Posterior Cramér–Rao lower bounds for extended target tracking with PMBM conjugate recursion

A Comparison of Posterior Cramer–Rao Bounds for Point and Extended Target Tracking

Event-triggered Adaptive Tracking Control for Stochastic Nonlinear Systems With State Constraints

Compact CRB for delay, Doppler, and phase estimation – application to GNSS SPP and RTK performance characterisation

A New Smoothing Approach with Diverse Fixed-Lags Based on Target Motion Model