1,395 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
Extrinsic Parameter Calibration for Line Scanning Cameras on Ground Vehicles with Navigation Systems Using a Calibration Pattern
Line scanning cameras, which capture only a single line of pixels, have been
increasingly used in ground based mobile or robotic platforms. In applications
where it is advantageous to directly georeference the camera data to world
coordinates, an accurate estimate of the camera's 6D pose is required. This
paper focuses on the common case where a mobile platform is equipped with a
rigidly mounted line scanning camera, whose pose is unknown, and a navigation
system providing vehicle body pose estimates. We propose a novel method that
estimates the camera's pose relative to the navigation system. The approach
involves imaging and manually labelling a calibration pattern with distinctly
identifiable points, triangulating these points from camera and navigation
system data and reprojecting them in order to compute a likelihood, which is
maximised to estimate the 6D camera pose. Additionally, a Markov Chain Monte
Carlo (MCMC) algorithm is used to estimate the uncertainty of the offset.
Tested on two different platforms, the method was able to estimate the pose to
within 0.06 m / 1.05 and 0.18 m / 2.39. We also propose
several approaches to displaying and interpreting the 6D results in a human
readable way.Comment: Published in MDPI Sensors, 30 October 201
PIEKF-VIWO: Visual-Inertial-Wheel Odometry using Partial Invariant Extended Kalman Filter
Invariant Extended Kalman Filter (IEKF) has been successfully applied in
Visual-inertial Odometry (VIO) as an advanced achievement of Kalman filter,
showing great potential in sensor fusion. In this paper, we propose partial
IEKF (PIEKF), which only incorporates rotation-velocity state into the Lie
group structure and apply it for Visual-Inertial-Wheel Odometry (VIWO) to
improve positioning accuracy and consistency. Specifically, we derive the
rotation-velocity measurement model, which combines wheel measurements with
kinematic constraints. The model circumvents the wheel odometer's 3D
integration and covariance propagation, which is essential for filter
consistency. And a plane constraint is also introduced to enhance the position
accuracy. A dynamic outlier detection method is adopted, leveraging the
velocity state output. Through the simulation and real-world test, we validate
the effectiveness of our approach, which outperforms the standard Multi-State
Constraint Kalman Filter (MSCKF) based VIWO in consistency and accuracy
A 3D Omnidirectional Sensor For Mobile Robot Applications
International audienc
Controlling rigid formations of mobile agents under inconsistent measurements
Despite the great success of using gradient-based controllers to stabilize
rigid formations of autonomous agents in the past years, surprising yet
intriguing undesirable collective motions have been reported recently when
inconsistent measurements are used in the agents' local controllers. To make
the existing gradient control robust against such measurement inconsistency, we
exploit local estimators following the well known internal model principle for
robust output regulation control. The new estimator-based gradient control is
still distributed in nature and can be constructed systematically even when the
number of agents in a rigid formation grows. We prove rigorously that the
proposed control is able to guarantee exponential convergence and then
demonstrate through robotic experiments and computer simulations that the
reported inconsistency-induced orbits of collective movements are effectively
eliminated.Comment: 10 page
- …