提出高阶高斯过程轨迹表示,实现连续时间运动估计的精确与高效
A Third-Order Gaussian Process Trajectory Representation Framework with Closed-Form Kinematics for Continuous-Time Motion Estimation
- 基于三阶高斯过程建模运动,支持 $SO(3) imesbR^3$ 与 $SE(3)$ 统一表示
- 推导出 $SO(3)$ 和 $SE(3)$ 的闭式局部变量导数,提升高速场景估计精度
- 提供解析雅可比矩阵,加速优化,适合定位、校准与里程计研究
本文提出一种三阶(即加加速度为白噪声)高斯过程轨迹表示框架,用于连续时间运动估计任务。该框架统一建模 $SO(3) imesbR^3$ 与 $SE(3)$ 姿态表示的运动学模型,使用户可用同一测量因子实现两种表示的实验与对比。不同于以往依赖泰勒展开近似的做法,本框架首次推导出 $SO(3)$ 与 $SE(3)$ 局部变量的闭式时间导数,显著提升高速场景下的估计精度。所有插值状态对支撑点的解析雅可比矩阵以及运动先验因子均提供,支持加速高斯-牛顿优化。实验验证了该框架在定位、标定和里程计等任务中的有效性与高效性,助力运动估计研究快速原型开发。源代码已开源,项目地址:https://github.com/brytsknguyen/gptr。
原文摘要 · Abstract (English)
In this paper, we propose a third-order, i.e., white-noise-on-jerk, Gaussian Process (GP) Trajectory Representation (TR) framework for continuous-time (CT) motion estimation (ME) tasks. Our framework features a unified trajectory representation that encapsulates the kinematic models of both $SO(3)\times\mathbb{R}^3$ and $SE(3)$ pose representations. This encapsulation strategy allows users to use the same implementation of measurement-based factors for either choice of pose representation, which facilitates experimentation and comparison to achieve the best model for the ME task. In addition, unique to our framework, we derive the kinematic models with the closed-form temporal derivatives of the local variable of $SO(3)$ and $SE(3)$, which so far has only been approximated based on the Taylor expansion in the literature. Our experiments show that these kinematic models can improve the estimation accuracy in high-speed scenarios. All analytical Jacobians of the interpolated states with respect to the support states of the trajectory representation, as well as the motion prior factors, are also provided for accelerated Gauss-Newton (GN) optimization. Our experiments demonstrate the efficacy and efficiency of the framework in various motion estimation tasks such as localization, calibration, and odometry, facilitating fast prototyping for ME researchers. We release the source code for the benefit of the community. Our project is available at https://github.com/brytsknguyen/gptr.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。