240 research outputs found
On-Manifold Preintegration for Real-Time Visual-Inertial Odometry
Current approaches for visual-inertial odometry (VIO) are able to attain
highly accurate state estimation via nonlinear optimization. However, real-time
optimization quickly becomes infeasible as the trajectory grows over time, this
problem is further emphasized by the fact that inertial measurements come at
high rate, hence leading to fast growth of the number of variables in the
optimization. In this paper, we address this issue by preintegrating inertial
measurements between selected keyframes into single relative motion
constraints. Our first contribution is a \emph{preintegration theory} that
properly addresses the manifold structure of the rotation group. We formally
discuss the generative measurement model as well as the nature of the rotation
noise and derive the expression for the \emph{maximum a posteriori} state
estimator. Our theoretical development enables the computation of all necessary
Jacobians for the optimization and a-posteriori bias correction in analytic
form. The second contribution is to show that the preintegrated IMU model can
be seamlessly integrated into a visual-inertial pipeline under the unifying
framework of factor graphs. This enables the application of
incremental-smoothing algorithms and the use of a \emph{structureless} model
for visual measurements, which avoids optimizing over the 3D points, further
accelerating the computation. We perform an extensive evaluation of our
monocular \VIO pipeline on real and simulated datasets. The results confirm
that our modelling effort leads to accurate state estimation in real-time,
outperforming state-of-the-art approaches.Comment: 20 pages, 24 figures, accepted for publication in IEEE Transactions
on Robotics (TRO) 201
Robust Legged Robot State Estimation Using Factor Graph Optimization
Legged robots, specifically quadrupeds, are becoming increasingly attractive
for industrial applications such as inspection. However, to leave the
laboratory and to become useful to an end user requires reliability in harsh
conditions. From the perspective of state estimation, it is essential to be
able to accurately estimate the robot's state despite challenges such as uneven
or slippery terrain, textureless and reflective scenes, as well as dynamic
camera occlusions. We are motivated to reduce the dependency on foot contact
classifications, which fail when slipping, and to reduce position drift during
dynamic motions such as trotting. To this end, we present a factor graph
optimization method for state estimation which tightly fuses and smooths
inertial navigation, leg odometry and visual odometry. The effectiveness of the
approach is demonstrated using the ANYmal quadruped robot navigating in a
realistic outdoor industrial environment. This experiment included trotting,
walking, crossing obstacles and ascending a staircase. The proposed approach
decreased the relative position error by up to 55% and absolute position error
by 76% compared to kinematic-inertial odometry.Comment: 8 pages, 12 figures. Accepted to RA-L + IROS 2019, July 201
Hybrid Contact Preintegration for Visual-Inertial-Contact State Estimation Using Factor Graphs
The factor graph framework is a convenient modeling technique for robotic
state estimation where states are represented as nodes, and measurements are
modeled as factors. When designing a sensor fusion framework for legged robots,
one often has access to visual, inertial, joint encoder, and contact sensors.
While visual-inertial odometry has been studied extensively in this framework,
the addition of a preintegrated contact factor for legged robots has been only
recently proposed. This allowed for integration of encoder and contact
measurements into existing factor graphs, however, new nodes had to be added to
the graph every time contact was made or broken. In this work, to cope with the
problem of switching contact frames, we propose a hybrid contact preintegration
theory that allows contact information to be integrated through an arbitrary
number of contact switches. The proposed hybrid modeling approach reduces the
number of required variables in the nonlinear optimization problem by only
requiring new states to be added alongside camera or selected keyframes. This
method is evaluated using real experimental data collected from a Cassie-series
robot where the trajectory of the robot produced by a motion capture system is
used as a proxy for ground truth. The evaluation shows that inclusion of the
proposed preintegrated hybrid contact factor alongside visual-inertial
navigation systems improves estimation accuracy as well as robustness to vision
failure, while its generalization makes it more accessible for legged
platforms.Comment: Detailed derivations are provided in the supplementary material
document listed under "Ancillary files
- …