A Group Theoretic Metric for Robot State Estimation Leveraging Chebyshev Interpolation
Authors:
- Varun AgrawalVAVarun Agrawal
- Frank DellaertFDFrank Dellaert
Preprint
Abstract
We propose a new metric for robot state estimation based on the recently introduced $\text{SE}_2(3)$ Lie group definition. Our metric is related to prior metrics for SLAM but explicitly takes into account the linear velocity of the state estimate, improving over current pose-based trajectory analysis. This has the benefit of providing a single, quantitative metric to evaluate state estimation algorithms against, while being compatible with existing tools and libraries. Since ground truth data generally consists of pose data from motion capture systems, we also propose an approach to compute the ground truth linear velocity based on polynomial interpolation. Using Chebyshev interpolation and a pseudospectral parameterization, we can accurately estimate the ground truth linear velocity of the trajectory in an optimal fashion with best approximation error. We demonstrate how this approach performs on multiple robotic platforms where accurate state estimation is vital, and compare it to alternative approaches such as finite differences. The pseudospectral parameterization also provides a means of trajectory data compression as an additional benefit. Experimental results show our method provides a valid and accurate means of comparing state estimation systems, which is also easy to interpret and report.
Keywords
All Related Versions
This publication has 28 references indexed in Scilit:
- What’s Wrong with the Absolute Trajectory Error?2025
- Cerberus: Low-Drift Visual-Inertial-Leg Odometry For Agile Locomotion2023
- Proprioceptive State Estimation of Legged Robots with Kinematic Chain Modeling2022
- Contact Forces Preintegration for Estimation in Legged Robotics using Factor Graphs2021
- Continuous-time State & Dynamics Estimation using a Pseudo-Spectral Parameterization2021
- Efficient Derivative Computation for Cumulative B-Splines on Lie Groups2020
- A Mathematical Framework for IMU Error Propagation with Applications to Preintegration2020
- Are We Ready for Autonomous Drone Racing? The UZH-FPV Drone Racing Dataset2019
- MAV indoor navigation based on a closed-form solution for absolute scale velocity estimation using Optical Flow and inertial data2011
- Numerical differentiation of experimental data: local versus global methodsComputer Physics Communications, 2007