Saved in:
Bibliographic Details
Main Authors: Singh, Surya Pratap, Lazouski, Tsimafei, Ghaffari, Maani
Format: Preprint
Published: 2025
Subjects:
Online Access:https://arxiv.org/abs/2507.02198
Tags: Add Tag
No Tags, Be the first to tag this record!
_version_ 1866912461724057600
author Singh, Surya Pratap
Lazouski, Tsimafei
Ghaffari, Maani
author_facet Singh, Surya Pratap
Lazouski, Tsimafei
Ghaffari, Maani
contents This paper presents an extension of the DRIFT invariant state estimation framework, enabling robust fusion of GPS and IMU data for accurate pose and heading estimation. Originally developed for testing and usage on a marine autonomous surface vehicle (ASV), this approach can also be utilized on other mobile systems. Building upon the original proprioceptive only DRIFT algorithm, we develop a symmetry-preserving sensor fusion pipeline utilizing the invariant extended Kalman filter (InEKF) to integrate global position updates from GPS directly into the correction step. Crucially, we introduce a novel heading correction mechanism that leverages GPS course-over-ground information in conjunction with IMU orientation, overcoming the inherent unobservability of yaw in dead-reckoning. The system was deployed and validated on a customized Blue Robotics BlueBoat, but the methodological focus is on the algorithmic approach to fusing exteroceptive and proprioceptive sensors for drift-free localization and reliable orientation estimation. This work provides an open source solution for accurate yaw observation and localization in challenging or GPS-degraded conditions, and lays the groundwork for future experimental and comparative studies.
format Preprint
id arxiv_https___arxiv_org_abs_2507_02198
institution arXiv
publishDate 2025
record_format arxiv
spellingShingle GPS-DRIFT: Marine Surface Robot Localization using IMU-GPS Fusion and Invariant Filtering
Singh, Surya Pratap
Lazouski, Tsimafei
Ghaffari, Maani
Robotics
This paper presents an extension of the DRIFT invariant state estimation framework, enabling robust fusion of GPS and IMU data for accurate pose and heading estimation. Originally developed for testing and usage on a marine autonomous surface vehicle (ASV), this approach can also be utilized on other mobile systems. Building upon the original proprioceptive only DRIFT algorithm, we develop a symmetry-preserving sensor fusion pipeline utilizing the invariant extended Kalman filter (InEKF) to integrate global position updates from GPS directly into the correction step. Crucially, we introduce a novel heading correction mechanism that leverages GPS course-over-ground information in conjunction with IMU orientation, overcoming the inherent unobservability of yaw in dead-reckoning. The system was deployed and validated on a customized Blue Robotics BlueBoat, but the methodological focus is on the algorithmic approach to fusing exteroceptive and proprioceptive sensors for drift-free localization and reliable orientation estimation. This work provides an open source solution for accurate yaw observation and localization in challenging or GPS-degraded conditions, and lays the groundwork for future experimental and comparative studies.
title GPS-DRIFT: Marine Surface Robot Localization using IMU-GPS Fusion and Invariant Filtering
topic Robotics
url https://arxiv.org/abs/2507.02198