# Integrating generic sensor fusion algorithms with sound state representations through encapsulation of manifolds

@article{Hertzberg2013IntegratingGS, title={Integrating generic sensor fusion algorithms with sound state representations through encapsulation of manifolds}, author={Christoph Hertzberg and Ren{\'e} Wagner and Udo Frese and Lutz Schr{\"o}der}, journal={Inf. Fusion}, year={2013}, volume={14}, pages={57-77} }

Common estimation algorithms, such as least squares estimation or the Kalman filter, operate on a state in a state space S that is represented as a real-valued vector. However, for many quantities, most notably orientations in 3D, S is not a vector space, but a so-called manifold, i.e. it behaves like a vector space locally but has a more complex global topological structure. For integrating these quantities, several ad hoc approaches have been proposed. Here, we present a principled solution…

## Figures, Tables, and Topics from this paper

## 186 Citations

Multi-Sensor Fusion and Active Perception for Autonomous Deep Space Navigation

- Computer Science2018 21st International Conference on Information Fusion (FUSION)
- 2018

An approach for active perception is proposed, which selects the desired attitude of the spacecraft based on the knowledge about the dynamics of celestial objects, the kind of information they provide as well as the current uncertainty of the filters.

Embedding manifold structures into Kalman filters

- Computer ScienceArXiv
- 2021

A generic symbolic representation for errorstate Kalman filters on manifolds, implemented as a toolkit in C++ packages with which users need only to cast the system model into the canonical form without going through the cumbersome hand-derivation of the on-manifold Kalman filter.

On the Manifold: Representing Geometry in C++ for State Estimation

- Computer Science
- 2018

Wave_geometry is presented, a C++ manifold geometry library providing representations of objects in affine, Euclidean, and projective spaces, and the Lie groups SO(3) and SE(3), and an expression template-based automatic differentiation system and compile-time checking of coordinate frame semantics.

IEKF-based Visual-Inertial Odometry using Direct Photometric Feedback

- Mathematics
- 2017

This paper presents a visual-inertial odometry framework which tightly fuses inertial measurements with visual data from one or more cameras, by means of an iterated extended Kalman filter (IEKF). By…

Articulated pose estimation via over-parametrization and noise projection

- Computer ScienceRobotics: Science and Systems
- 2014

An algorithm to estimate the pose of a generic articulated object by using a particle filter implementation which is unique in that it does not require a reliable state transition model, and which evaluates noise in the observation space, rather than state space.

Robust visual inertial odometry using a direct EKF-based approach

- EngineeringIROS 2015
- 2015

In this paper, we present a monocular visual-inertial odometry algorithm which, by directly using pixel intensity errors of image patches, achieves accurate tracking performance while exhibiting a…

Robust visual inertial odometry using a direct EKF-based approach

- Computer Science2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS)
- 2015

A monocular visual-inertial odometry algorithm which achieves accurate tracking performance while exhibiting a very high level of robustness by directly using pixel intensity errors of image patches, leading to a truly power-up-and-go state estimation system.

On the Development of a Generic Multi-Sensor Fusion Framework for Robust Odometry Estimation

- Computer Science
- 2014

How a high level, clean, C++/Python API, as long as ROS interface nodes, hide the complexity of sensor fusion tasks to the end user, making ROAMFREE an ideal choice for new, and existing, mobile robot projects.

Articulated pose estimation using tangent space approximations

- Mathematics, Computer ScienceInt. J. Robotics Res.
- 2016

An algorithm to estimate the pose of a generic articulated object using a particle filter implementation which is unique in that it does not require a reliable state transition model and the novel use of a precision matrix allows observations which do not provide complete 6-DOF pose information to be processed.

Extrinsic Calibration from Per-Sensor Egomotion

- Computer ScienceRobotics: Science and Systems
- 2012

The algorithm takes noisy, per-sensor incremental egomotion observations as input and produces as output an estimate of the maximum-likelihood 6-DOF calibration relating the sensors and accompanying uncertainty, producing an analysis of motion degeneracy and a singularity-free optimization procedure.

## References

SHOWING 1-10 OF 65 REFERENCES

Application of the manifold-constrained unscented Kalman filter

- Engineering2008 IEEE/ION Position, Location and Navigation Symposium
- 2008

This document describes the rationale and methodology behind the application of a Kalman-type filter to a system that has two properties which lead to inaccuracy or instability in traditional…

Real-time simultaneous localisation and mapping with a single camera

- Computer ScienceProceedings Ninth IEEE International Conference on Computer Vision
- 2003

This work presents a top-down Bayesian framework for single-camera localisation via mapping of a sparse set of natural features using motion modelling and an information-guided active measurement strategy, in particular addressing the difficult issue of real-time feature initialisation via a factored sampling approach.

Rapid development of manifold-based graph optimization systems for multi-sensor calibration and SLAM

- Computer Science2011 IEEE/RSJ International Conference on Intelligent Robots and Systems
- 2011

It is shown that MTKM makes it particularly easy to solve non-trivial multi-sensor calibration problems while remaining generic enough to handle a very different class of problems, namely SLAM, as well as several SLAM benchmark data sets illustratingMTKM's versatility.

Scale Drift-Aware Large Scale Monocular SLAM

- Computer ScienceRobotics: Science and Systems
- 2010

This paper describes a new near real-time visual SLAM system which adopts the continuous keyframe optimisation approach of the best current stereo systems, but accounts for the additional challenges presented by monocular input and presents a new pose-graph optimisation technique which allows for the efficient correction of rotation, translation and scale drift at loop closures.

Sigma-point kalman filters for probabilistic inference in dynamic state-space models

- Mathematics
- 2004

Probabilistic inference is the problem of estimating the hidden variables (states or parameters) of a system in an optimal and consistent fashion as a set of noisy or incomplete observations of the…

New extension of the Kalman filter to nonlinear systems

- Computer Science, EngineeringDefense, Security, and Sensing
- 1997

It is argued that the ease of implementation and more accurate estimation features of the new filter recommend its use over the EKF in virtually all applications.

Nonlinear Constraint Network Optimization for Efficient Map Learning

- Mathematics, Computer ScienceIEEE Transactions on Intelligent Transportation Systems
- 2009

This paper addresses the so-called graph-based formulation of simultaneous localization and mapping (SLAM) and can be seen as an extension of Olson's algorithm toward non-flat environments and applies a novel parameterization of the nodes of the graph that significantly improves the performance of the algorithm and can cope with arbitrary network topologies.

An extended Kalman filter for quaternion-based orientation estimation using MARG sensors

- Physics, Computer ScienceProceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180)
- 2001

An extended Kalman filter for real-time estimation of rigid body orientation using the newly developed MARG (magnetic, angular rate, and gravity) sensors, which eliminates the long-standing problem of singularities associated with attitude estimation.

Global Positioning Systems, Inertial Navigation, and Integration

- Engineering
- 2000

An updated guide to GNSS and INS, and solutions to real-world GPS/INS problems with Kalman filtering Written by recognized authorities in the field, this second edition of a landmark work provides…

Iterative Estimation of Rotation and Translation using the Quaternion

- Mathematics
- 1995

In this paper, we consider some practical issues when using the quaternion to represent rotation in conjunction with gradientor Jacobian-based search algorithms. Iterative estimation techniques often…