Method and system for registering an object with a probe using entropy-based motion selection and Rao-Blackwellized particle filtering

摘要

A probe is registered with an object by probing the object with the probe at multiple poses, wherein each pose of the probe includes a location and an orientation. A probability distribution of a current location of the probe is represented by a set of particles, and a probability distribution of a current orientation of the probe is represented by a Gaussian distribution for each particle conditioned on the current location. A set of candidate motions is chosen, and for each candidate motion, an expected uncertainty based on the set of particles is determined. The candidate motion with a least expected uncertainty is selected as a next motion of the probe, the probe is moved according to the next motion, and the set of particles is updated using the next pose of the probe.