Multi Body Kalman Filtering with Articulation Constraints for Humanoid Robot Pose and Motion Estimation

  • Daniel Hauschildt
  • Sören Kerner
  • Stefan Tasse
  • Oliver Urbann
Part of the Lecture Notes in Computer Science book series (LNCS, volume 7416)


In this paper, a concept for articulated rigid body state estimation is proposed. The articulated body, for instance a humanoid robot, is modeled in a maximal coordinate formulation and the articulations between the rigid bodies as nonlinear position and linear motion constraints. At first, the individual state of each particular rigid body is estimated with a Kalman filter, which leads to an unconstrained state estimate. Subsequently, the correct state estimate for the articulated rigid body is derived by projecting the unconstrained estimate onto the constraint surface.


Rigid Body Motion Estimation Humanoid Robot Biped Robot Rotation Error 
These keywords were added by machine and not by the authors. This process is experimental and the keywords may be updated as the learning algorithm improves.


  1. 1.
    Aoustin, Y., Plestan, F., Lebastard, V.: Experimental comparison of several posture estimation solutions for biped robot rabbit. In: IEEE International Conference on Robotics and Automation, ICRA 2008, pp. 1270–1275 (May 2008)Google Scholar
  2. 2.
    Baumgarte, J.: Stabilization of constraints and integrals of motion in dynamical systems. In: Computer Methods in Applied Mechanics and Engineering (1972)Google Scholar
  3. 3.
    Bender, J.: Impulse-based dynamic simulation in linear time. Computer Animation and Virtual Worlds 18(4-5), 225–233 (2007)CrossRefGoogle Scholar
  4. 4.
    Cline, M.B., Pai, D.K.: Post-stabilization for rigid body simulation with contact and constraints. In: IEEE Intl. Conf. on Robotics and Automation (2003)Google Scholar
  5. 5.
    Halvorsen, K., Söderström, T., Stokes, V., Lanshammar, H.: Using an extended Kalman filter for rigid body pose estimation. Journal of Biomechanical Engineering 127(3), 475–483 (2005), CrossRefGoogle Scholar
  6. 6.
    Kraft, E.: A quaternion-based unscented Kalman-filter for orientation tracking. Tech. rep. (2003)Google Scholar
  7. 7.
    Laue, T., Spiess, K., Röfer, T.: SimRobot – A General Physical Robot Simulator and Its Application in RoboCup. In: Bredenfeld, A., Jacoff, A., Noda, I., Takahashi, Y. (eds.) RoboCup 2005. LNCS (LNAI), vol. 4020, pp. 173–183. Springer, Heidelberg (2006)CrossRefGoogle Scholar
  8. 8.
    Simon, D., Chia, T.L.: Kalman filtering with state equality constraints. IEEE Transactions on Aerospace and Electronic Systems 38(1), 128–136 (2002)CrossRefGoogle Scholar
  9. 9.
    Smith, R.: Opensource dynaminc engine (2004),

Copyright information

© Springer-Verlag Berlin Heidelberg 2012

Authors and Affiliations

  • Daniel Hauschildt
    • 1
  • Sören Kerner
    • 1
  • Stefan Tasse
    • 1
  • Oliver Urbann
    • 1
  1. 1.Robotics Research Institute, Section Information TechnologyTU Dortmund UniversityDortmundGermany

Personalised recommendations