Bayesian Hybrid Model-State Estimation Applied to Simultaneous Contact Formation Recognition and Geometrical Parameter Estimation

Abstract

In this paper we describe a Bayesian approach to model selection and state estimation for sensor-based robot tasks. The approach is illustrated with a hybrid model-state estimation example from force-controlled autonomous compliant motion: simultaneous (discrete) contact formation recognition and estimation of (continuous) geometrical parameters. Previous research in this area mostly tries to solve one of the two subproblems, or treats the contact formation recognition problem separately, avoiding integration between the solutions to the contact formation recognition and the geometrical parameter estimation problems. A more powerful hybrid model, explicitly modeling contact formation transitions, is developed to deal with larger uncertainties. This paper demonstrates that Kalman filter variants have limits: iterated extended Kalman filters can only handle small uncertainties on the geometrical parameters, while the non-minimal state Kalman filter cannot deal with model selection. Particle filters can handle the increased level of model complexity. Explicit measurement equations for the particle filter are derived from the implicit kinematic and energetic constraints. The experiments prove that the particle filter approach successfully estimates the hybrid joint posterior density of the discrete contact formation variable and the 12-dimensional, continuous geometrical parameter vector during the execution of an assembly task. The problem shows similarities with the well-known problems of data association in simultaneous localization and map-building (SLAM) and model selection in global localization.

Get full access to this article

View all access options for this article.

References

Asada, H. 1993. Representation and learning of nonlinear compliance using neural nets . IEEE Transactions on Robotics and Automation 9(6): 863-867 .

Bar-Shalom, Y. and Fortmann, T. E. 1988. Tracking and Data Association. Mathematics in Science and Engineering. Academic Press, New York .

Bar-Shalom, Y. and Li, X. 1993. Estimation and Tracking, Principles, Techniques, and Software, Artech House, Boston, MA .

Berzuini, C. and Gilks, W. 2001. RESAMPLE-MOVE filtering with cross-model jumps. Sequential Monte Carlo Methods in Practice, A. Doucet, N. de Freitas, and N. Gordon, editors, Springer-Verlag, Berlin , pp. 117-138.

Debus, T., Dupont, P., and Howe, R. 2002. Contact state estimation using multiple model estimation and hidden Markov models . Proceedings of the International Symposium on Experimental Robotics, Sant’Angelo d’Ischia, Italy.

De Schutter, J. and Van Brussel, H. 1988. Compliant motion I, II . International Journal of Robotics Research 7(4): 3-33 .

De Schutter, J., Bruyninckx, H., Dutré, S., De Geeter, J., Katupitiya, J., Demey, S., and Lefebvre, T. 1999. Estimating first-order geometric parameters and monitoring contact transitions during force-controlled compliant motions . International Journal of Robotics Research 18(12): 1161-1184 .

Doucet, A. and Tadic, V. B. 2003. Parameter estimation in general state-space models using particle methods . Annals of the Institute of Statistical Mathematics 55(2): 409-422 .

Doucet, A., Godsill, S., and Andrieu, C. 2000. On sequential Monte Carlo sampling methods for Bayesian filtering . Statistics and Computing 10(3): 197-208 .

10.

Doucet, A., de Freitas, N., and Gordon, N., editors. 2001. Sequential Monte Carlo Methods in Practice. Statistics for engineering and information science. Springer-Verlag, Berlin .

11.

Eberman, B. 1997. A model-based approach to Cartesian manipulation contact sensing . International Journal of Robotics Research 16(4): 508-528 .

12.

Gadeyne, K. and Bruyninckx, H. 2001. Markov techniques for object localization with force-controlled robots . Proceedings of the International Conference on Advanced Robotics, Budapest, Hungary, pp. 91-96 .

13.

Gilks, W. R. and Berzuini, C. 2001. Following a moving target—Monte Carlo inference for dynamic Bayesian models . Journal of the Royal Statistical Society 63(Part 1): 127-146 .

14.

Gordon, N., Salmond, D. J., and Smith, A. F. M. 1993. Novel approach to nonlinear/non-Gaussian state estimation . IEE Proceedings F 140(2): 107-113 .

15.

Hannaford, B. and Lee, P. 1991. Hidden Markov model analysis of force/torque information in telemanipulation . International Journal of Robotics Research 10(5): 528-539 .

16.

Hirukawa, H., Papegay, Y., and Matsui, T. 1994. A motion planning algorithm for convex polyhedra in contact under translation and rotation . Proceedings of the International Conference on Robotics and Automation, San Diego, CA, May, pp. 3020-3027 .

17.

Hovland, G. E. and McCarragher, B. J. 1998. Hidden Markov models as a process monitor in robotic assembly . International Journal of Robotics Research 17(2): 153-168 .

18.

1998, reprinted by Oxford University Press ).

19.

Kalman, R. E. 1960. A new approach to linear filtering and prediction problems . Transactions of the ASME, Journal of Basic Engineering 82: 34-45 .

20.

Kitagawa, G. 1998. A self-organizing state-space model . Journal of the American Statistical Association 93(443): 1203-1215 .

21.

Lefebvre, T. 2003. Contact modelling, parameter identification and task planning for autonomous compliant motion using elementary contacts. Ph.D. Thesis, Katholieke Universiteit Leuven, May.

22.

Lefebvre, T., Bruyninckx, H., and De Schutter, J. 2003a. Polyhedral contact formation modeling and identification for autonomous compliant motion . IEEE Transactions on Robotics and Automation 19(3): 26-41 .

23.

Lefebvre, T., Bruyninckx, H., and De Schutter, J. 2003b. Kalman filters for nonlinear systems: a comparison of performance . International Journal of Control 77(7): 639-653 .

24.

Lefebvre, T., Bruyninckx, H., and De Schutter, J. 2004. Exact nonlinear Bayesian parameter estimation for autonomous compliant motion . Advanced Robotics 18(8): 787-800 .

25.

Lefebvre, T., Bruyninckx, H., and De Schutter, J. 2005. Polyhedral contact formation identification for autonomous compliant motion: exact nonlinear Bayesian filtering . IEEE Transactions on Robotics and Automation 21(1): 124-129 .

26.

Liu, J. S. and Chen, R. 1998. Sequential Monte Carlo methods for dynamic systems . Journal of the American Statistical Association 93(443): 1032-1044 .

27.

Liu, J. S. and West, M. 2001. Combined parameter and state estimation in simulation-based filtering. Sequential Monte Carlo Methods in Practice, A. Doucet, N. de Freitas, and N. Gordon, editors, Springer-Verlag, Berlin , pp. 197-223.

28.

MacEachern, S. N., Clyde, M. A., and Liu, J. S. 1999. Sequential importance sampling for non-parametric Bayes models: the next generation . Canadian Journal of Statistics 27(2): 251-267 .

29.

Mihaylova, L., Lefebvre, T., Staffetti, E., Bruyninckx, H., and De Schutter, J. 2002. Contact transitions tracking during force-controlled compliant motion using an interacting multiple model estimator . Information and Security 9: 114-129 .

30.

Mimura, N. and Funahashi, Y. 1994. Parameter identification of contact conditions by active force sensing . Proceedings of the International Conference on Robotics and Automation, San Diego, CA, pp. 2645-2650 .

31.

Montemerlo, M. and Thrun, S. 2003. Simultaneous localization and mapping with unknown data association . Proceedings of the International Conference on Robotics and Automation, Taipei, Taiwan, pp. 1985-1991 .

32.

Montemerlo, M., Thrun, S., Koller, D., and Wegbreit, B. 2002. FastSLAM: a factored solution to the simultaneous localization and mapping problem . Proceedings of the National Conference on Artificial Intelligence, Edmonton, Alberta, Canada, pp. 593-598 .

33.

Murphy, K. P. and Russell, S. 2001.Rao-Blackwellized particle filtering for dynamic Bayesian networks. Sequential Monte Carlo Methods in Practice, A. Doucet, N. de Freitas, and N. Gordon, editors, Springer-Verlag, Berlin , pp. 499-516.

34.

Nieto, J., Guivant, J., Nebot, E., and Thrun, S. 2003. Real-time data association for FastSLAM . Proceedings of the International Conference on Robotics and Automation, Taipei, Taiwan, pp. 412-418 .

35.

Pitt, M. and Shephard, N. 1999. Filtering via simulation: auxiliary particle filters . Journal of the American Statistical Association 94(446): 590-599 .

36.

Ripley, B. D. 1987. Stochastic Simulation, Wiley, New York .

37.

Skubic, M. and Volz, R. 2000. Identifying single-ended contact formations from force sensor patterns . IEEE Transactions on Robotics and Automation 16(5): 597-603 .

38.

Slaets, P., Rutgeerts, J., Gadeyne, K., Lefebvre, T., Bruyninckx, H., and De Schutter, J. 2004. Construction of a geometric 3D model from sensor measurements collected during compliant motion . Proceedings of the International Symposium on Experimental Robotics, Singapore, in press.

39.

Thrun, S., Burgard, W., and Fox, D. 1998. A probabilistic approach to concurrent mapping and localization for mobile robots . Machine Learning and Autonomous Robots 31: 29-53 .

40.

van der Merwe, R., Doucet, A., de Freytas, N., and Wan, E. 2000. The Unscented Particle Filter. Technical Report CUED/F-INFENG/TR 380, Cambridge University Engineering Department, Cambridge, UK, August.

41.

Xiao, J. and Ji, X. 2001. On automatic generation of high-level contact state space . International Journal of Robotics Research 20(7): 584-606 .