Nonlinear Stochastic Position and Attitude Filter on the Special Euclidean Group 3

Hashim A. Hashim, Lyndon J. Brown, Kenneth McIsaac

This paper formulates the pose estimation problem as nonlinear stochastic filter kinematics evolved directly on the Special Euclidean Group SE(3). Proposed filter guarantees that t…