This paper is dedicated to achieving scalable relative state estimation using inter-robot Euclidean distance measurements. We consider equipping robots with distance sensors and focus on the optimization problem underlying relative state estimation in this setup. We reveal the commonality between this problem and the coordinates realization problem of a sensor network. Based on this insight, we propose an effective unconstrained optimization model to infer the relative states among robots. To work on this model in a distributed manner, we propose an efficient and scalable optimization algorithm with the classical block coordinate descent method as its backbone. This algorithm exactly solves each block update subproblem with a closed-form solution while ensuring convergence. Our results pave the way for distance measurements-based relative state estimation in large-scale multi-robot systems.
翻译:本文致力于利用机器人间欧氏距离测量实现可扩展的相对状态估计。我们考虑为机器人配备距离传感器,并聚焦于该场景下相对状态估计的优化问题。我们揭示了该问题与传感器网络坐标实现问题的共性。基于这一认识,我们提出了一种有效的无约束优化模型来推断机器人之间的相对状态。为了以分布式方式求解该模型,我们提出了一种高效且可扩展的优化算法,以经典块坐标下降法为核心。该算法通过闭式解精确求解每个块更新子问题,同时保证收敛性。我们的研究结果为大规模多机器人系统中基于距离测量的相对状态估计铺平了道路。