Integrating generic sensor fusion algorithms with sound state representations through encapsulation of manifolds
Integrating generic sensor fusion algorithms with sound state representations through encapsulation of manifolds
复制标题
DOI:
10.1016/j.inffus.2011.08.003
复制
发表时间:
2013-01-01
影响因子:
18.6
通讯作者:
Schroeder, Lutz
中科院分区:
文献类型:
--
作者:
Hertzberg, Christoph;Wagner, Rene;Schroeder, Lutz
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 to this problem where the structure of the manifold S is encapsulated by two operators, state displacement boxed plus : S x R-n -> S and its inverse boxed minus : S x S -> R-n These operators provide a local vector-space view delta bar right arrow x boxed plus delta around a given state X. Generic estimation algorithms can then work on the manifold S mainly by replacing +/- with boxed plus/boxed minus where appropriate. We analyze these operators axiomatically, and demonstrate their use in least-squares estimation and the Unscented Kalman Filter. Moreover, we exploit the idea of encapsulation from a software engineering perspective in the Manifold Toolkit, where the boxed plus/boxed minus operators mediate between a "flat-vector" view for the generic algorithm and a "named-members" view for the problem specific functions. (C) 2011 Elsevier B.V. All rights reserved.