Contact State Estimation Using Multiple Model Estimation and Hidden Markov Models

In this paper we present an approach to estimating the contact state between a robot and its environment during task execution. Contact states are modeled by constraint equations parametrized by timedependent sensor data and time-independent object properties. At each sampling time, multiple model estimation is used to assess the most likely contact state. The assessment is performed by a hidden Markov model, which combines a measure of how well each set of constraint equations fits the sensor data with the probability of specific contact state transitions. The latter is embodied in a task-based contact state network. The approach is illustrated for a three-dimensional peg-in-hole insertion using a tabletop manipulator robot. Using only position sensing, the contact state sequence is successfully estimated without knowledge of nominal property values. Property estimates are obtained for the peg dimensions as well as the hole position and orientation.

[1]  Blake Hannaford,et al.  The BlueDRAGON - a system for measuring the kinematics and dynamics of minimally invasive surgical tools in-vivo , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[2]  Brenan J. McCarragher.  Petri net modelling for robotic assembly and trajectory planning , 1994, IEEE Trans. Ind. Electron..

[3]  L. Baum,et al.  Statistical Inference for Probabilistic Functions of Finite State Markov Chains , 1966 .

[4]  Joris De Schutter,et al.  Estimating First-Order Geometric Parameters and Monitoring Contact Transitions during Force-Controlled Compliant Motion , 1999, Int. J. Robotics Res..

[5]  B. Hannaford,et al.  Hidden Markov Model of Force Torque Information in Telemanipulation , 1991 .

[6]  Dana H. Ballard,et al.  Recognizing teleoperated manipulations , 1993, [1993] Proceedings IEEE International Conference on Robotics and Automation.

[7]  Joris De Schutter,et al.  Polyhedral contact formation modeling and identification for autonomous compliant motion , 2003, IEEE Trans. Robotics Autom..

[8]  H. Harry Asada,et al.  The Discrete Event Modeling and Trajectory Planning of Robotic Assembly Tasks , 1995 .

[9]  Arthur C. Sanderson,et al.  Task decomposition and analysis of robotic assembly task plans using Petri nets , 1994, IEEE Trans. Ind. Electron..

[10]  Robert D. Howe,et al.  Automatic identification of local geometric properties during teleoperation , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[11]  Brian S. Eberman.  A Model-Based Approach to Cartesian Manipulation Contact Sensing , 1997, Int. J. Robotics Res..

[12]  Paolo Fiorini,et al.  Neural networks for offline segmentation of teleoperation tasks , 1992, Proceedings of the 1992 IEEE International Symposium on Intelligent Control.

[13]  B. E. Griebenow.  Buried-waste integrated demonstration retrieval projects , 1994 .

[14]  Robert D. Howe,et al.  Experimental identification of kinematic constraints , 1997, Proceedings of International Conference on Robotics and Automation.

[15]  John M. Hollerbach,et al.  The Calibration Index and Taxonomy for Robot Kinematic Calibration Methods , 1996, Int. J. Robotics Res..

[16]  Brenan J. McCarragher.  Force sensing from human demonstration using a hybrid dynamical model and qualitative reasoning , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[17]  Robert D. Howe,et al.  Automatic Identification of Environment Haptic Properties , 1999, Presence.

[18]  Lawrence R. Rabiner,et al.  A tutorial on hidden Markov models and selected applications in speech recognition , 1989, Proc. IEEE.

[19]  Jorge J. Moré,et al.  The Levenberg-Marquardt algo-rithm: Implementation and theory , 1977 .