cs.ROOct 30, 2024

A Third-Order Gaussian Process Trajectory Representation Framework with Closed-Form Kinematics for Continuous-Time Motion Estimation

Authors: Thien-Minh Nguyen, Ziyu Cao, Kailai Li, William Talbot, Tongxing Jin, Shenghai Yuan, Timothy D. Barfoot, Lihua Xie

Organizations: School of Electrical and Electronic Engineering, Nanyang Technological University, 50 Nanyang Avenue, Singapore 639798. · Department of Electrical Engineering, Linköping University, 58183 Linköping, Sweden. · Bernoulli Institute for Mathematics, Computer Science and Artificial Intelligence, University of Groningen, 9747 AG Groningen, the Netherlands. · Robotic Systems Lab (RSL), ETH Zürich, 8092 Zürich, Switzerland. · 

Abstract

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)×R3SO(3)\times\mathbb{R}^3 and SE(3)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)SO(3) and SE(3)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.

Figures & tables

Explore similar work

CardsList
  1. Smoothing Out the Edges: Continuous-Time Estimation with Gaussian Process Motion Priors on Factor Graphs

    May 9, 2026Connor Holmes, Sven Lilge, Zi Cong Guo +2Gaussian ProcessesRobot State Estimation

  2. Breaking Time: A Fully Gaussian Framework for Distributed and Continuous-Time SLAM

    Jun 4, 2026Davide Ceriola, Simone Ferrari, Luca Di Giammarino +2Simultaneous Localization and MappingBayesian Inference