Continuous-time trajectory representation has gained significant popularity in recent years, as it offers an elegant formulation that allows the fusion of a larger number of sensors and sensing modalities, overcoming limitations of traditional discrete-time frameworks. To bolster the adoption of the continuous-time paradigm, we propose a so-called Gaussian Process Trajectory Representation (GPTR) framework for continuous-time motion estimation (CTME) tasks. Our approach stands out by employing a third-order random jerk model, featuring closed-form expressions for both rotational and translational state derivatives. This model provides smooth, continuous trajectory representations that are crucial for precise estimation of complex motion. To support the wider robotics and computer vision communities, we have made the source code for GPTR available as a light-weight header-only library. This format was chosen for its ease of integration, allowing developers to incorporate GPTR into existing systems without needing extensive code modifications. Moreover, we also provide a set of optimization examples with LiDAR, camera, IMU, UWB factors, and closed-form analytical Jacobians under the proposed GP framework. Our experiments demonstrate the efficacy and efficiency of GP-based trajectory representation in various motion estimation tasks, and the examples can serve as the prototype to help researchers quickly develop future applications such as batch optimization, calibration, sensor fusion, trajectory planning, etc., with continuous-time trajectory representation. Our project is accessible at https://github.com/brytsknguyen/gptr .
翻译:近年来,连续时间轨迹表示因其优雅的数学形式而广受欢迎,该形式能够融合更多传感器与感知模态,克服了传统离散时间框架的局限性。为促进连续时间范式的应用,我们提出了一种称为高斯过程轨迹表示(GPTR)的框架,用于连续时间运动估计(CTME)任务。本方法的突出特点在于采用三阶随机加加速度模型,该模型具有旋转与平移状态导数的闭式表达式。该模型提供了平滑、连续的轨迹表示,这对于精确估计复杂运动至关重要。为支持更广泛的机器人学与计算机视觉社区,我们已将GPTR的源代码发布为一个轻量级的仅头文件库。选择此格式是为了便于集成,使开发者能够在不需大量代码修改的情况下将GPTR融入现有系统。此外,我们还提供了一组基于所提高斯过程框架的优化示例,包含LiDAR、相机、IMU、UWB因子及闭式解析雅可比矩阵。实验证明了基于高斯过程的轨迹表示在各种运动估计任务中的有效性与高效性,这些示例可作为原型帮助研究者快速开发未来应用,如批量优化、标定、传感器融合、轨迹规划等,均基于连续时间轨迹表示。项目地址为 https://github.com/brytsknguyen/gptr 。