Talk · Conference of Open Innovations Association · April 28, 2026
Beyond Kalman Filtering: a Dual Quaternion Geometric Observer for Robust 6DoF Pose Estimation
Abstract
Autonomous robots and wearable devices operating in dynamic 3D environments require robust pose estimation that preserves the geometric structure of rigid-body motion. Traditional filtering approaches, such as Extended Kalman Filters (EKF), often decouple rotation and translation, leading to linearization artifacts and kinematic inconsistencies. This paper presents a comprehensive benchmark of a Dual Quaternion Geometric Observer (GeoDQ) against state-of-the-art manifoldaware filters (UKF-M) and standard error-state filters (ESKF). We introduce an optimized architecture featuring a Screw Linear Interpolation (SCLERP) fusion mechanism, augmented with a heuristic tilt correction, PID-based feedback loops, and Numbabased JIT compilation for real-time performance. Evaluated on 35 distinct trajectories from the RoNIN dataset under wearable smartphone configurations with unstable IMU orientations, the proposed GeoDQ (JIT) achieves a Root Mean Square Error (RMSE) of 0.0043 m. By interpolating directly on the$S E(3)$manifold, GeoDQ outperforms the standard ESKF (0.1409 m) and UKF-M (0.2312 m) by orders of magnitude. Furthermore, robustness analysis demonstrates that the geometric observer exhibits smooth error growth under severe measurement decimation, maintaining sub-meter accuracy where filter-based methods rapidly diverge. Despite its mathematical rigor, the JIToptimized GeoDQ executes in just 3.0 s per trajectory, making it significantly faster than standard Python-based filters and highly suitable for edge computing applications, wearable devices, and resource-constrained platforms.
More by Ilya Afanasyev
- Geometric State Fusion for Autonomous Agents: A Comparative Analysis of Dual Quaternion Observer and Kalman FiltersAdaptive Agents and Multi-Agents Systems · 2026
- Efficient Document Image Dewarping via Hybrid Deep Learning and Cubic Polynomial Geometry RestorationResearch Square · 2025 · Citations: 1
- Modern Methods of Map Construction Using Optical Sensors FusionProceedings of International Conference on Artificial Life and Robotics · 2023 · Citations: 6
- Game Theory–Based Parameter Tuning for Energy-Efficient Path Planning on Modern UAVsACM Transactions on Cyber-Physical Systems · 2022 · Citations: 5
