Using an extended kalman filter for rigid body pose estimation.

Rigid body pose is commonly represented as the rigid body transformation from one (often reference) pose to another This is usually computed for each frame of data without any assumptions or restrictions on the temporal change of the pose. The most common algorithm was proposed by Söderkvist and Wedin (1993, "Determining the Movements of the Skeleton Using Well-configured Markers," J. Biomech., 26, pp. 1473-1477), and implies the assumption that measurement errors are isotropic and homogenous. This paper describes an alternative method based on a state space formulation and the application of an extended Kalman filter (EKF). State space models are formulated, which describe the kinematics of the rigid body. The state vector consists of six generalized coordinates (corresponding to the 6 degrees of freedom), and their first time derivatives. The state space models have linear dynamics, while the measurement function is a non-linear relation between the state vector and the observations (marker positions). An analytical expression for the linearized measurement function is derived. Tracking the rigid body motion using an EKF enables the use of a priori information on the measurement noise and type of motion to tune the filter. The EKF is time variant, which allows for a natural way of handling temporarily missing marker data. State updates are based on all the information available at each time step, even when data from fewer than three markers are available. Comparison with the method of Söderkvist and Wedin on simulated data showed a considerable improvement in accuracy with the proposed EKF method when marker data was temporarily missing. The proposed method offers an improvement in accuracy of rigid body pose estimation by incorporating knowledge of the characteristics of the movement and the measurement errors. Analytical expressions for the linearized system equations are provided, which eliminate the need for approximate discrete differentiation and which facilitate a fast implementation.

[1]  B. Anderson,et al.  Optimal Filtering , 1979, IEEE Transactions on Systems, Man, and Cybernetics.

[2]  R. Singer.  Estimating Optimal Tracking Filter Performance for Manned Maneuvering Targets , 1970, IEEE Transactions on Aerospace and Electronic Systems.

[3]  Kevin Nickels,et al.  Model-based tracking of complex articulated objects , 2001, IEEE Trans. Robotics Autom..

[4]  Sukhan Lee,et al.  A Kalman filter approach for accurate 3-D motion estimation from a sequence of stereo images , 1991, CVGIP Image Underst..

[5]  Naoya Ohta,et al.  Optimal Estimation of Three-Dimensional Rotation and Reliability Evaluation , 1998, ECCV.

[6]  Roy Mathias,et al.  A Chain Rule for Matrix Functions and Applications , 1996, SIAM J. Matrix Anal. Appl..

[7]  Kjartan Halvorsen,et al.  Model-Based Methods in Motion Capture , 2002 .

[8]  C. Barus.  A treatise on the theory of screws , 1998 .

[9]  Yaakov Bar-Shalom,et al.  Estimation and Tracking: Principles, Techniques, and Software , 1993 .

[10]  Alex Pentland,et al.  3D structure from 2D motion , 1999, IEEE Signal Process. Mag..

[11]  Rama Chellappa,et al.  3-D Motion Estimation Using a Sequence of Noisy Stereo Images: Models, Estimation, and Uniqueness Results , 1990, IEEE Trans. Pattern Anal. Mach. Intell..

[12]  Nicholas Ayache,et al.  Artificial vision for mobile robots - stereo vision and multisensory perception , 1991 .

[13]  I Söderkvist,et al.  Determining the movements of the skeleton using well-configured markers. , 1993, Journal of biomechanics.

[14]  H. Woltring.  3-D attitude representation of human joints: a standardization proposal. , 1994, Journal of biomechanics.

[15]  Richard M. Murray,et al.  A Mathematical Introduction to Robotic Manipulation , 1994 .

[16]  Sandro Fioretti,et al.  Signal processing in movement analysis (a state-space approach) , 1996 .

[17]  H. Woltring.  On optimal smoothing and derivative estimation from noisy displacement data in biomechanics , 1985 .

[18]  Es Grood,et al.  A joint coordinate system for the clinical description of three-dimensional motions: Application to the human knee joint. , 1983 .

[19]  E S Grood,et al.  A joint coordinate system for the clinical description of three-dimensional motions: application to the knee. , 1983, Journal of biomechanical engineering.

[20]  G Ferrigno,et al.  Robust recovery of human motion from video using Kalman filters and virtual humans. , 2003, Human movement science.

[21]  Herman J. Woltring,et al.  A fortran package for generalized, cross-validatory spline smoothing and differentiation , 1986 .