用连续几何动力学优化多机器人位姿图,收敛快且通信少。
Distributed Pose Graph Optimization via Continuous Riemannian Dynamics

- 将位姿优化建模为黎曼流形上的阻尼动力系统
- 在同步和异步场景下均优于现有分布式算法
- 适合多机器人系统,支持延迟通信下的精准预测
我们提出一种基于连续黎曼动力学的分布式位姿图优化框架,将位姿变量视为受阻尼作用的质点,其平衡点对应原始位姿图优化问题的一阶临界点。通过求解阻尼欧拉-庞加莱方程并采用半隐式几何积分器,设计了一种广义优化算法,可统一现有方法如黎曼梯度下降与高斯-牛顿法。在多机器人场景中,基于块对角质量与阻尼矩阵,实现完全分布式并行计算,各机器人仅需解自身姿态的常微分方程,通信开销极低。同时,状态与速度联合建模支持合理的邻居预测,在延迟通信下显著提升收敛性能。理论分析表明,所采用的几何离散化方案满足能量耗散条件。在基准位姿图优化数据集上的实验验证了该方法在同步与异步环境下均优于当前最先进的分布式基线。
原文摘要 · Abstract (English)
We present a framework for distributed Pose Graph Optimization (PGO) by formulating the problem as a second-order continuous-time dynamical system evolving on Lie groups. By modeling pose variables as massive particles subject to damping, the equilibrium points of the resulting Riemannian dynamics coincide with first-order critical points of the original PGO problem. Using the governing damped Euler--Poincaré equations and a semi-implicit geometric integrator, we design an optimization algorithm that generalizes existing algorithms such as Riemannian gradient descent and Gauss--Newton. In multi-robot settings, we present a fully distributed and parallel method based on block-diagonal mass and damping matrices, where each robot solves an ordinary differential equation for its own poses with minimal communication overhead. Moreover, modeling both state and velocity enables principled neighbor prediction that significantly improves convergence under delayed communication. Theoretically, we present an analysis and establish sufficient condition that ensures energy dissipation under the employed geometric discretization scheme. Experiments on benchmark PGO datasets demonstrate that the proposed solver achieves superior performance compared to state-of-the-art distributed baselines in both synchronous and asynchronous regimes.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。