Estimating SE(3) elements using a dual quaternion based linear Kalman filter
نویسندگان
چکیده
Many applications in robotics such as registration, object tracking, sensor calibration, etc. use Kalman filters to estimate a time invariant SE(3) element by locally linearizing a non-linear measurement model. Linearization-based filters tend to suffer from inaccurate estimates, and in some cases divergence, in the presence of large initialization errors. In this work, we use a dual quaternion to represent the SE(3) element and use multiple measurements simultaneously to rewrite the measurement model in a truly linear form with state dependent measurement noise. Use of the linear measurement model bypasses the need for any linearization in prescribing the Kalman filter, resulting in accurate estimates while being less sensitive to initial estimation error. To show the broad applicability of this approach, we derive linear measurement models for applications that use either position measurements or pose measurements. A procedure to estimate the state dependent measurement uncertainty is also discussed. The efficacy of the formulation is illustrated using simulations and hardware experiments for two applications in robotics: rigid registration and sensor calibration.
منابع مشابه
A Stochastic H∞ Filter for Spacecraft Attitude Estimation
A filter for estimating spacecraft attitude quaternion and gyro drift from vector measurements in the presence of white noises in the gyro error, in the drift dynamics, and in the line-of-sight measurement error is developed. The variance parameters of the white noises are unknown, and are modeled as non-anticipative second order stochastic processes. The approach taken in this work consists in...
متن کاملA Comparison of Unscented and Extended Kalman Filtering for Estimating Quaternion Motion
The unscented Kalman filter is a superior alternative to the extended Kalman filter for a variety of estimation and control problems. However, its effectiveness for improving human motion tracking for virtual reality applications in the presence of noisy data has been unexplored. In this paper, we present an empirical study comparing the performance of unscented and extended Kalman filtering fo...
متن کاملA New Adaptive Extended Kalman Filter for a Class of Nonlinear Systems
This paper proposes a new adaptive extended Kalman filter (AEKF) for a class of nonlinear systems perturbed by noise which is not necessarily additive. The proposed filter is adaptive against the uncertainty in the process and measurement noise covariances. This is accomplished by deriving two recursive updating rules for the noise covariances, these rules are easy to implement and reduce the n...
متن کاملUnscented Filtering for Spacecraft Attitude Estimation
A new spacecraft attitude estimation approach based on the Unscented Filter is derived. For nonlinear systems the Unscented Filter uses a carefully selected set of sample points to more accurately map the probability distribution than the linearization of the standard Extended Kalman Filter, leading to faster convergence from inaccurate initial conditions in attitude estimation problems. The fi...
متن کاملذخیره در منابع من
با ذخیره ی این منبع در منابع من، دسترسی به آن را برای استفاده های بعدی آسان تر کنید
عنوان ژورنال:
دوره شماره
صفحات -
تاریخ انتشار 2016