Efficient Derivative Computation for Cumulative B-Splines on Lie Groups

Abstract

Continuous-time trajectory representation has recently gained popularity for tasks where the fusion of high-frame-rate sensors and multiple unsynchronized devices is required. Lie group cumulative B-splines are a popular way of representing continuous trajectories without singularities. They have been used in near real-time SLAM and odometry systems with IMU, LiDAR, regular, RGB-D and event cameras, as well as for offline calibration. These applications require efficient computation of time derivatives (velocity, acceleration), but all prior works rely on a computationally suboptimal formulation. In this work we present an alternative derivation of time derivatives based on recurrence relations that needs $\mathcal{O}(k)$ instead of $\mathcal{O}(k^2)$ matrix operations (for a spline of order $k$) and results in simple and elegant expressions. While producing the same result, the proposed approach significantly speeds up the trajectory optimization and allows for computing simple analytic derivatives with respect to spline knots. The results presented in this paper pave the way for incorporating continuous-time trajectory representations into more applications where real-time performance is required.

First two authors contributed equally

References in corpus (3)

• The TUM VI Benchmark for Evaluating Visual-Inertial Odometry
• Real-Time Trajectory Replanning for MAVs using Uniform B-splines and a 3D Circular Buffer
• Continuous-Time Visual-Inertial Odometry for Event Cameras

Cited by in corpus (14)

• CMax-SLAM: Event-based Rotational-Motion Bundle Adjustment and SLAM System using Contrast Maximization
• Spatiotemporal Calibration of Camera and 3D Laser Scanner
• A Continuous-Time Approach for 3D Radar-to-Camera Extrinsic Calibration
• Coco-LIC: Continuous-Time Tightly-Coupled LiDAR-Inertial-Camera Odometry using Non-Uniform B-spline
• Spatiotemporal Calibration of 3D Millimetre-Wavelength Radar-Camera Pairs
• Eigen Is All You Need: Efficient Lidar-Inertial Continuous-Time Odometry with Internal Association
• Continuous-Time Ultra-Wideband-Inertial Fusion
• EF-Calib: Spatiotemporal Calibration of Event- and Frame-Based Cameras Using Continuous-Time Trajectories
• Observability-Aware Trajectory Optimization: Theory, Viability, and State of the Art
• Informed Guided Rapidly-Exploring Random Trees*-Connect for Path Planning of Walking Robots
• On Embedding B-Splines in Recursive State Estimation
• Incorporating Control Inputs in Continuous-Time Gaussian Process State Estimation for Robotics
• Event-based Photometric Bundle Adjustment
• Autonomous Flight in Unknown GNSS-denied Environments for Disaster Examination