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纳入现有系统而无需大量代码修改。此外,我们还提供了一组在提出的GP框架下,包含LiDAR、相机、IMU、UWB因子及闭式解析雅可比矩阵的优化示例。我们的实验证明了基于GP的轨迹表示在各种运动估计任务中的有效性和效率,这些示例可作为原型,帮助研究人员快速开发未来应用,如批量优化、标定、传感器融合、轨迹规划等,并利用连续时间轨迹表示。我们的项目可通过 https://github.com/brytsknguyen/gptr 访问。