Egoistic MDS-based Rigid Body Localization
This paper addresses the problem of prior-free relative pose estimation between unknown-shape rigid bodies in autonomous driving. We propose an anchor-free rigid-body localization method that relies solely on one-sided ranging measurements. Our key contribution is the first integration of multidimensional scaling (MDS) with a bi-centering operator into rigid-body kinematic modeling—eliminating the conventional requirement of geometric shape consistency between the two bodies and enabling ego-centric pose estimation for arbitrarily shaped, heterogeneous rigid bodies. The method constructs an MDS framework from the distance matrix and jointly optimizes it under rigid-body kinematic constraints. Simulation results demonstrate significant reductions in RMSE for both translational and rotational pose estimates across diverse rigid-body configurations. The approach exhibits strong robustness to measurement noise and generalizes effectively across disparate geometric morphologies.