arXiv:2512.20931cs.RO2025-12被引 2

用对偶方法实现高精度卫星定位方向的可验证解,2颗星也能保证最优。

Certifiable Alignment of GNSS and Local Frames via Lagrangian Duality

  • 将定位问题转为凸松弛模型,通过拉格朗日对偶求解
  • 仅需2颗卫星+多普勒数据,即可获得可验证最优解
  • 适合低卫星信号环境下的机器人导航系统

估计局部坐标系相对于全球导航卫星系统(GNSS)参考系的绝对姿态常受局部极小值和卫星可用性影响。现有方法依赖大量卫星,在信号弱环境下不可行;或采用局部优化,无法保证解的最优性。本文提出一种全局最优求解器,将原始伪距或多普勒测量转化为凸松弛问题,具有可验证性,填补了传统局部优化器的空白。首先将原帧对齐问题建模为非凸二次约束二次规划(QCQP),并松弛为凹的拉格朗日对偶问题,提供原问题的下界成本。随后进行松弛紧致性和可观测性分析,推导出解可验证最优性的判据。仿真与真实实验表明,本方法在仅2颗卫星且车辆二维运动条件下仍能提供可验证最优解,而传统基于速度的VOBA方法与先进GVINS对齐技术可能失效或陷入局部最优而不自知。为支持机器人领域GNSS导航技术发展,所有代码与数据已开源:https://github.com/Baoshan-Song/Certifiable-Doppler-alignment。

原文摘要 · Abstract (English)

Estimating the absolute orientation of a local system relative to a global navigation satellite system (GNSS) reference often suffers from local minima and high dependency on satellite availability. Existing methods for this alignment task rely on abundant satellites unavailable in GNSS-degraded environments, or use local optimization methods which cannot guarantee the optimality of a solution. This work introduces a globally optimal solver that transforms raw pseudo-range or Doppler measurements into a convexly relaxed problem. The proposed method is certifiable, meaning it can numerically verify the correctness of the result, filling a gap where existing local optimizers fail. We first formulate the original frame alignment problem as a nonconvex quadratically constrained quadratic program (QCQP) problem and relax the QCQP problem to a concave Lagrangian dual problem that provides a lower cost bound for the original problem. Then we perform relaxation tightness and observability analysis to derive criteria for certifiable optimality of the solution. Finally, simulation and real world experiments are conducted to evaluate the proposed method. The experiments show that our method provides certifiably optimal solutions even with only 2 satellites with Doppler measurements and 2D vehicle motion, while the traditional velocity-based VOBA method and the advanced GVINS alignment technique may fail or converge to local optima without notice. To support the development of GNSS-based navigation techniques in robotics, all code and data are open-sourced at https://github.com/Baoshan-Song/Certifiable-Doppler-alignment.

GNSS对齐凸优化可验证性机器人导航

Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。