Picasso: Holistic Scene Reconstruction with Physics-Constrained Sampling
Xihang Yu, Rajat Talak, Lorenzo Shaikewitz, Luca Carlone
TL;DR
Picasso addresses the challenge of physically plausible multi-object scene reconstruction under occlusions and noise by integrating geometry, non-penetration, and physics into a rejection-sampling framework guided by a contact scene graph. It decouples holistic scene reasoning into sequential, tractable subproblems and achieves fast inference by GPU-accelerated coarse-to-fine sampling. The Picasso dataset and the Scene Plausibility Score provide ground-truth, metrics, and benchmarks for physical plausibility, with extensive experiments showing improved pose accuracy and plausibility on YCB-V and Picasso datasets and alignment with human intuition. This work advances digital twin construction for contact-rich scenes, enabling more reliable simulation-based planning and control in robotics and related domains.
Abstract
In the presence of occlusions and measurement noise, geometrically accurate scene reconstructions -- which fit the sensor data -- can still be physically incorrect. For instance, when estimating the poses and shapes of objects in the scene and importing the resulting estimates into a simulator, small errors might translate to implausible configurations including object interpenetration or unstable equilibrium. This makes it difficult to predict the dynamic behavior of the scene using a digital twin, an important step in simulation-based planning and control of contact-rich behaviors. In this paper, we posit that object pose and shape estimation requires reasoning holistically over the scene (instead of reasoning about each object in isolation), accounting for object interactions and physical plausibility. Towards this goal, our first contribution is Picasso, a physics-constrained reconstruction pipeline that builds multi-object scene reconstructions by considering geometry, non-penetration, and physics. Picasso relies on a fast rejection sampling method that reasons over multi-object interactions, leveraging an inferred object contact graph to guide samples. Second, we propose the Picasso dataset, a collection of 10 contact-rich real-world scenes with ground truth annotations, as well as a metric to quantify physical plausibility, which we open-source as part of our benchmark. Finally, we provide an extensive evaluation of Picasso on our newly introduced dataset and on the YCB-V dataset, and show it largely outperforms the state of the art while providing reconstructions that are both physically plausible and more aligned with human intuition.
