CHSEL: Producing Diverse Plausible Pose Estimates from Contact and Free Space Data

Sheng Zhong,Nima Fazeli,Dmitry Berenson
DOI: https://doi.org/10.48550/arXiv.2305.08042
2023-05-14
Abstract:This paper proposes a novel method for estimating the set of plausible poses of a rigid object from a set of points with volumetric information, such as whether each point is in free space or on the surface of the object. In particular, we study how pose can be estimated from force and tactile data arising from contact. Using data derived from contact is challenging because it is inherently less information-dense than visual data, and thus the pose estimation problem is severely under-constrained when there are few contacts. Rather than attempting to estimate the true pose of the object, which is not tractable without a large number of contacts, we seek to estimate a plausible set of poses which obey the constraints imposed by the sensor data. Existing methods struggle to estimate this set because they are either designed for single pose estimates or require informative priors to be effective. Our approach to this problem, Constrained pose Hypothesis Set Elimination (CHSEL), has three key attributes: 1) It considers volumetric information, which allows us to account for known free space; 2) It uses a novel differentiable volumetric cost function to take advantage of powerful gradient-based optimization tools; and 3) It uses methods from the Quality Diversity (QD) optimization literature to produce a diverse set of high-quality poses. To our knowledge, QD methods have not been used previously for pose registration. We also show how to update our plausible pose estimates online as more data is gathered by the robot. Our experiments suggest that CHSEL shows large performance improvements over several baseline methods for both simulated and real-world data.
Robotics,Computer Vision and Pattern Recognition
What problem does this paper attempt to address?
The problem that this paper attempts to solve is to estimate a set of possible poses of a rigid object given a set of points containing volume information (for example, whether these points are in free space or on the object surface). Specifically, the author has studied how to estimate poses from forces and tactile data generated by contact. Since contact data is inherently less information - dense than visual data, the pose - estimation problem is severely under - constrained when there are few contact points. Traditional methods are difficult to estimate this set of possible poses because they are either designed for single - pose estimation or require informative priors to be effective. To solve these problems, the author proposes a method named **Constrained pose Hypothesis Set Elimination (CHSEL)**, which has the following three key properties: 1. **Consider volume information**: Allows us to take into account the known free space. 2. **Use a new differentiable volume cost function**: Utilize powerful gradient - based optimization tools. 3. **Use Quality Diversity (QD) optimization method**: Generate a set of high - quality and diverse pose estimates. Through these methods, CHSEL can estimate a set of possible poses that conform to the sensor - data constraints when the contact data is limited. In addition, the paper also shows how to update pose estimates online as the robot collects more data. Experimental results show that CHSEL significantly outperforms several baseline methods on both simulated and real - world data.