Nonparametric Second-order Theory of Error Propagation on Motion Groups

Abstract

Error propagation on the Euclidean motion group arises in a number of areas such as in dead reckoning errors in mobile robot navigation and joint errors that accumulate from the base to the distal end of kinematic chains such as manipulators and biological macromolecules. We address error propagation in rigid-body poses in a coordinate-free way. In this paper we show how errors propagated by convolution on the Euclidean motion group, SE133, can be approximated to second order using the theory of Lie algebras and Lie groups. We then show how errors that are small (but not so small that linearization is valid) can be propagated by a recursive formula derived here. This formula takes into account errors to second order, whereas prior efforts only considered the first-order case. Our formulation is non-parametric in the sense that it will work for probability density functions of any form (not only Gaussians). Numerical tests demonstrate the accuracy of this second-order theory in the context of a manipulator arm and a flexible needle with bevel tip.

Keywords

recursive error propagation Euclidean group spatial uncertainty.

Get full access to this article

View all access options for this article.

References

Alterovitz, R. , Simeon, T. and Goldberg, K. (2007). The stochastic motion roadmap: a sampling framework for planning with Markov motion uncertainty. Proceedings of Robotics Science and Systems, Atlanta, GA, June.

Anderson, T.W. (2005). An Introduction to Multivariate Statistical Analysis , 3rd edn. New York, Wiley.

Baker, H.F. (1904). Alternants and continuous groups. Proceedings of the London Mathematical Society (Second Series), 3: 24-47.

Campbell, J.E. (1897). On a law of combination of operators. Proceedings of the London Mathematical Society, 29: 14- 32.

Chirikjian, G.S. (2009). Stochastic Models, Information Theory, and Lie Groups. New York, Birkhäuser, to appear.

Chirikjian, G.S. and Kyatkin, A.B. (2001). Engineering Applications of Noncommutative Harmonic Analysis. Boca Raton, FL, CRC Press .

Craig, J.J. (2005). Introduction to Robotics Mechanics and Control , 3rd edn. Englewood Cliffs, NJ, Prentice-Hall.

Higham, D.J. (2001). An algorithmic introduction to numerical simulation of stochastic differential equations. SIAM Review, 43(3): 525-546.

Hausdorff, F. (1906). Die symbolische Exponentialformel in der Gruppentheorie . Berichte der Sachsichen Akademie der Wissenschaften, 58: 19-48.

10.

Kim, J.-S. and Chirikjian, G.S. (2005). A unified approach to conformational statistics of classical polymer and polypeptide models. Polymer , 46(25): 11,904-11,917.

11.

Murray, R.M. , Li, Z. and Sastry, S.S. (1994). A Mathematical Introduction to Robotic Manipulation . Boca Raton, FL, CRC Press.

12.

Park, F.C. (1991). The optimal kinematic design of mechanisms. Ph.D. Thesis, Cambridge, MA, Harvard University, Division of Engineering and Applied Sciences.

13.

Park, W. , Kim, J.S. , Zhou, Y. , Cowan, N.J. , Okamura, A.M. and Chirikjian, G.S. (2005). Diffusion-based motion planning for a nonholonomic flexible needle model. Proceedings of the IEEE International Conference on Robotics and Automation , pp. 4600-4605.

14.

Park, W. , Liu, Y. , Moses, M. and Chirikjian, G.S. (2008). Kinematic state estimation and motion planning for stochastic nonholonomic systems using the exponential map. Robotica, 26(4): 419-434.

15.

Selig, J.M. (1996). Geometrical Methods in Robotics. New York, Springer.

16.

Smith, P. , Drummond, T. and Roussopoulos, K. (2003). Computing MAP trajectories by representing, propagating and combining PDFs over groups. Proceedings of the 9th IEEE International Conference on Computer Vision, Vol. II, pp. 1275-1282.

17.

Smith, R.C. and Cheeseman, P. (1986). On the representation and estimation of spatial uncertainty. The International Journal of Robotics Research , 5(4): 56-68.

18.

Su, S. and Lee, C.S.G. (1992). Manipulation and propagation of uncertainty and verification of applicability of actions in assembly tasks. IEEE Transactions on Systems, Man, and Cybernetics, 22(6): 1376-1389.

19.

Thrun, S. , Burgard, W. and Fox, D. (2005). Probabilistic Robotics. Cambridge, MA, MIT Press.

20.

Wang, Y. and Chirikjian, G.S. (2006a). Error propagation on the Euclidean group with applications to manipulator kinematics. IEEE Transactions on Robotics, 22(4): 591-602.

21.

Wang, Y. and Chirikjian, G.S. (2006b). Error propagation in hybrid serial-parallel manipulators. Proceedings of the IEEE International Conference on Robotics and Automation, Orlando, FL, May, pp. 1848-1853.

22.

Webster, R.J. III , Kim, J.S. , Cowan, N.J. , Chirikjian, G.S. and Okamura, A.M. (2006). Nonholonomic modeling of needle steering. The International Journal of Robotics Research, 25: 509-525.

23.

Zhou, Y. and Chirikjian, G.S. (2006). Conformational statistics of semi-flexible macromolecular chains with internal joints. Macromolecules, 39(5): 1950-1960.