Learning object deformation models for robot motion planning

https://doi.org/10.1016/j.robot.2014.04.005Get rights and content

Highlights

  • We present a planning system for robots in environments with deformable objects.

  • A manipulation robot determines the deformation parameters of real objects.

  • We consider the costs of object deformations by finite element simulations.

  • The deformation costs are modeled using Gaussian processes for efficient planning.

  • Application to wheeled and manipulation robots operating in real environments.

Abstract

In this paper, we address the problem of robot navigation in environments with deformable objects. The aim is to include the costs of object deformations when planning the robot’s motions and trade them off against the travel costs. We present our recently developed robotic system that is able to acquire deformation models of real objects. The robot determines the elasticity parameters by physical interaction with the object and by establishing a relation between the applied forces and the resulting surface deformations. The learned deformation models can then be used to perform physically realistic finite element simulations. This allows the planner to evaluate robot trajectories and to predict the costs of object deformations. Since finite element simulations are time-consuming, we furthermore present an approach to approximate object-specific deformation cost functions by means of Gaussian process regression. We present two real-world applications of our motion planner for a wheeled robot and a manipulation robot. As we demonstrate in real-world experiments, our system is able to estimate appropriate deformation parameters of real objects that can be used to predict future deformations. We show that our deformation cost approximation improves the efficiency of the planner by several orders of magnitude.

Introduction

Perceiving the surroundings and modeling the environment is an important competence of intelligent mobile robots since such models are required for efficiently solving other high-level tasks. For instance, generating a collision-free path through the environment in an efficient way requires path planning, which in turn builds on top of a model of the environment. There exists a variety of approaches for robots to autonomously generate an appropriate model of the environment by addressing the simultaneous localization and mapping problem  [1], [2], [3], [4], by autonomous exploration  [5], [6], [7], or by addressing both problems jointly  [8], [9].

In order to plan motions in learned environment models, the majority of path planning approaches assumes that the environment contains only rigid obstacles  [10], [11], [12], although there are a few notable exceptions such as the works of  [13], [14], [15], [16], [17]. In reality, not all obstacles are rigid. In domestic environments–a key target domain for service robots–a robot must deal with many deformable objects such as plants, curtains, or cloth. Considering that an object such as a curtain is deformable can enable a robot to accomplish navigation tasks that otherwise cannot be carried out.

To consider deformable objects in the path planning process, such objects need to be handled in a simulation system underlying the planner. The realistic simulation of object deformations is still an active area of research with a variety of relevant applications in computer graphics, virtual reality, games, movies, but also in robotics  [18], [19], and medical simulations  [20], [21], [22]. In most applications, the underlying parameters for an appropriate deformation simulation are adjusted manually until the results appear visually plausible. This might be applicable for computer games or movies, but does not necessarily lead to a physically realistic computation of the involved forces. These forces, however, need to be known accurately for navigation in the presence of deformable objects. For example, whenever a robot interacts with real-world objects, only limited forces should be applied to them. This is of utmost importance in medical applications or in domestic settings, for instance, whenever robots have to manipulate plants or clothes. Particularly in these domains, robots need exact knowledge about the parameters of the deformation process.

In this paper, we present a complete robotic system that is able to perceive the environment and model the deformable objects in the scene. The system estimates the deformation properties of objects, and finally is able to plan a trajectory through the environment, taking potential object deformations into account.

Estimating the elasticity parameters of objects not only involves observing and reconstructing the three-dimensional surface of an object. Physical interaction with the object under consideration is required to learn about its behavior when exposed to external forces. Therefore, we equipped our robot with a force sensor at the end of the manipulator and with a depth camera. Based on the observed surface deformations and corresponding forces, our approach seeks to determine the elasticity parameters of the object. This is done by simulating the object deformation under the applied forces using a linear finite element model. An error minimization approach is applied to iteratively adapt the deformation parameters such that the difference between the real object under deformation and the simulation is minimized. As we will demonstrate in the experimental section of this paper, our approach is able to find elasticity parameters that enable our robot to accurately predict the deformations of real-world objects.

Furthermore, we address the problem of planning motions for robots navigating in environments with deformable obstacles and to adequately consider the costs of object deformations. In this context, we present an efficient approximation of the deformation cost function of objects. Throughout this paper, we assume that the robot can deform the objects but does not move them in the environment. This allows us to generate a set of trajectory samples in a pre-processing step and to predict the costs of new trajectories by applying efficient Gaussian process regression. Using this regression approach, the robot is able to efficiently plan trajectories in the presence of deformable objects without the need for time-consuming simulations during runtime. In different experiments, we demonstrate that our approach yields accurate estimates and, at the same time, allows for efficient planning of trajectories along which the robot interacts with deformable objects.

This paper is organized as follows: after discussing related work in the next section, we will give an overview of our planning approach that considers deformable objects and describe the basic principles of the deformation model and the physical simulation underlying our planner in Section  3. In Section  4, we describe how to learn models of deformable objects with our manipulation robot. Next, we present our approach to approximate the deformation cost functions of objects using Gaussian process regression in Section  5. Subsequently, we present two applications of our path planning system applied to a manipulation robot and a wheeled robot. Finally, in Section  7, we evaluate our system in different experiments.

Section snippets

Deformable modeling and parameter estimation

Deformable modeling and parameter estimation are active areas of research. To represent non-rigid objects and to simulate deformations, mass–spring systems have been frequently used. They are easy to implement and can be simulated efficiently  [23], [24]. Their major drawback is the tedious modeling as there is no intuitive relation between spring constants and physical material properties in general  [25]. Finite element methods (FEMs) reflect physical properties of objects in a more natural

Path planning considering deformable obstacles

In this section, we give an overview of our planning approach and introduce the basic concepts of deformation simulations needed for model learning and planning.

Learning deformation models

Modeling the deformation behavior of real objects requires interaction with them to measure the forces as well as the resulting deformations. In this section, we introduce our approach to learn deformation models of real objects with a manipulation robot. The key idea is to compare the observations of the robot to a finite element simulation. The observation of the force allows us to establish the force–displacement relation from Eq. (9). In this way, we are able to estimate the parameters of

Deformation cost functions for planning

When planning robot motions, we want to consider the costs of object deformations that are introduced by the robot. To achieve this, we first define a measure for such deformation costs that can be obtained by means of physical simulation of the corresponding robot trajectory. Next, we will introduce the concept of object-dependent deformation cost functions that can be pre-computed under certain assumptions and speed up the planning process. Finally, we present our approach to model the

Applications on real robots

In this section, we present two applications of our proposed motion planning system. First, we discuss how to plan motions in 3D workspace for a manipulation robot. Second, we present an implementation on a wheeled robot that operates in the 2D plane. In this case, we additionally address the problem of collision avoidance.

Experiments

In this section, we present evaluations of our approaches to deformation model learning, deformation cost prediction, path planning, and collision avoidance.

Conclusion

In this paper, we presented several techniques to enable robot motion in environments with deformable obstacles. We addressed the acquisition of deformation models, efficient representations for planning, and application of the developed motion planning framework to robots operating in real-world environments.

Our robot is equipped with the sensors necessary to acquire models of deformable objects and determines their material parameters by minimizing the error between observed deformation and

Acknowledgments

The authors would like to thank Axel Rottmann for sharing his expertise on Gaussian process regression and Jörg Müller for his help with robotic hardware issues. This work has partly been supported by the DFG under contract number SFB/TR-8, by the European Commission under FP7-248258-First-MM, and by Microsoft Research, Redmond.

Barbara Frank is a postdoctoral research assistant at the University of Freiburg. Her research interests include robot motion planning, 3D reconstruction, and machine learning. In April 2013, she finished her Ph.D. thesis entitled “Techniques for Robot Motion Planning in Environments with Deformable Objects”, supervised by Wolfram Burgard, at the Department of Computer Science at the University of Freiburg. After studying at the University of Freiburg and the University of Aberdeen in Scotland,

References (78)

  • J. Kajberg et al.

    Characterization of materials subjected to large strains by inverse modeling based on in-plane displacement fields

    Int. J. Solids Struct.

    (2004)
  • M. Kauer et al.

    Inverse finite element characterization of soft tissues

    Med. Image Anal.

    (2002)
  • U. Frese et al.

    Simultaneous localization and mapping—a discussion

  • G. Grisetti et al.

    Hierarchical optimization on manifolds for online 2D and 3D mapping

  • V. Ila et al.

    Information-based compact pose SLAM

    IEEE Trans. Robot.

    (2010)
  • M. Kaess et al.

    iSAM2: incremental smoothing and mapping with fluid relinearization and incremental variable reordering

  • B. Yamauchi

    Frontier-based exploration using multiple robots

  • K. Wurm et al.

    Coordinated multi-robot exploration using a segmentation of the environment

  • P. Whaite et al.

    Autonomous exploration: driven by uncertainty

    IEEE Trans. Pattern Anal. Mach. Intell.

    (1997)
  • F. Bourgoult, A. Makarenko, S. Williams, B. Grocholsky, F. Durrant-Whyte, Information based adaptive robotic...
  • C. Stachniss et al.

    Information gain-based exploration using rao-blackwellized particle filters

  • J.-C. Latombe

    Robot Motion Planning

    (1991)
  • H. Choset et al.

    Principles of Robot Motion

    (2005)
  • S.~M. LaValle

    Planning Algorithms

    (2006)
  • E. Anshelevich et al.

    Deformable volumes in path planning applications

  • O.~B. Bayazit et al.

    Probabilistic roadmap motion planning for deformable objects

  • R. Gayle et al.

    Path planning for deformable robots in complex environments

  • R. Alterovitz et al.

    Sensorless motion planning for medical needle insertion in deformable tissues

    IEEE Trans. Inform. Technol. Biomed.

    (2009)
  • B. Maris et al.

    Trajectory planning with task constraints in densely filled environments

  • S. Rodríguez et al.

    Planning motion in completely deformable environments

  • S. Patil et al.

    Motion planning under uncertainty in highly deformable environments

  • M. Metzger et al.

    Simultaneous cutting of coupled tetrahedral and triangulated meshes and its application in orbital reconstruction

    Int. J. Comput. Assist. Radiol. Surg.

    (2009)
  • D. Chen et al.

    Pump it up: computer animation of a biomechanically based model of muscle using the finite element method

  • G. Picinbono et al.

    Non-linear and anisotropic elastic soft tissue models for medical simulation

  • M. Teschner et al.

    A versatile and robust model for geometrically complex deformable solids

  • F. Conti et al.

    Interactive rendering of deformable objects based on a filling sphere modelling approach

  • A. Nealen et al.

    Physically based deformable models in computer graphics

    Comput. Graph. Forum

    (2006)
  • K.-J. Bathe

    Finite Element Procedures

    (1996)
  • M. Hauth et al.

    Corotational simulation of deformable solids

  • M. Müller et al.

    Interactive virtual materials

  • S.~R. Mousavi et al.

    Statistical finite element method for real-time tissue mechanics analysis

    Comput. Methods Biomech. Biomed. Eng.

    (2012)
  • K.~K. Hauser et al.

    Interactive deformation using modal analysis with constraints

    Graphics Interface

    (2003)
  • M.~G. Choi et al.

    Modal warping: real-time simulation of large rotational deformation and manipulation

    IEEE Trans. Vis. Comput. Graphics

    (2005)
  • J. Kim et al.

    Fast simulation of skeleton-driven deformable body characters

    ACM Trans. Graph.

    (2011)
  • J. Barbič et al.

    Real-time subspace integration for St.Venant–Kirchhoff deformable models

    ACM Trans. Graph. (ACM SIGGRAPH)

    (2005)
  • G. Bianchi et al.

    Simultaneous topology and stiffness identification for mass–spring models based on FEM reference deformations

  • B. Lloyd et al.

    Identification of spring parameters for deformable object simulation

    IEEE Trans. Vis. Comput. Graphics

    (2007)
  • P. Fong

    Sensing, acquisition, and interactive playback of data-based models for elastic deformable objects

    Int.~J. Robot. Res.

    (2009)
  • B. Bickel et al.

    Capture and modeling of non-linear heterogeneous soft tissue

    Proc.~of ACM SIGGRAPH

    (2009)
  • Cited by (0)

    Barbara Frank is a postdoctoral research assistant at the University of Freiburg. Her research interests include robot motion planning, 3D reconstruction, and machine learning. In April 2013, she finished her Ph.D. thesis entitled “Techniques for Robot Motion Planning in Environments with Deformable Objects”, supervised by Wolfram Burgard, at the Department of Computer Science at the University of Freiburg. After studying at the University of Freiburg and the University of Aberdeen in Scotland, she received a diploma degree in Computer Science in spring 2007.

    Cyrill Stachniss is a professor at the University of Bonn, Germany where he heads the chair for photogrammetry. Until March 2014, he was a lecturer at the University of Freiburg in Germany. He focuses on probabilistic techniques in the context of mobile robotics, perception, and navigation problems. He finished his habilitation in November 2009 working as an academic advisor at the University of Freiburg. Before that, he was a senior researcher at the Swiss Federal Institute of Technology in the Autonomous Systems Lab of Roland Siegwart. In April 2006, he finished his Ph.D. thesis entitled “Exploration and Mapping with Mobile Robots”, supervised by Wolfram Burgard, at the Department of Computer Science at the University of Freiburg. From 2008–2013, he was an associate editor of the IEEE Transactions on Robotics, since 2010 a Microsoft Research Faculty Fellow, and received the IEEE RAS Early Career Award in 2013.

    Rüdiger Schmedding was a research assistant at the Department of Computer Science at the University of Freiburg until 2012. He finished his Ph.D. thesis entitled “Acquisition and simulation of deformable objects” under supervision of Matthias Teschner in June 2012. From 2001 to 2007, he studied Mathematics at the University of Freiburg and the University of Bonn. He received a diploma degree in Mathematics in 2007. His research interests include real-time rendering, scientific computing, physical simulation, and computer animation. From 2012 on, he is a teacher at an academic upper secondary school.

    Matthias Teschner is professor of Computer Science and head of the Computer Graphics group at the University of Freiburg. He received the Ph.D. degree in Electrical Engineering from the University of Erlangen-Nuremberg in 2000. From 2001 to 2004, he was a research associate at Stanford University and at the ETH Zurich. His research interests comprise physically-based simulation, computer animation, rendering and computational geometry with applications in robotics, medical simulation, and entertainment technology. He serves as an associate editor for Computer Graphics Forum and Computers & Graphics. He has served on program committees of major graphics conferences including Eurographics, Pacific Graphics, IEEE Vis, and ACM Siggraph/Eurographics SCA.

    Wolfram Burgard is a professor for Computer Science at the University of Freiburg, Germany where he heads the Laboratory for Autonomous Intelligent Systems. He received his Ph.D. degree in Computer Science from the University of Bonn in 1991. His areas of interest lie in artificial intelligence and mobile robots. In the past, he and his group developed several innovative probabilistic techniques for robot navigation and control. They cover different aspects such as localization, map-building, path-planning, and exploration. For his work, he received several best paper awards from outstanding national and international conferences. In 2009, he received the Gottfried Wilhelm Leibniz Prize, the most prestigious German research award. In 2010 he received the Advanced Grant of the European Research Council. He is the spokesperson of the Research Training Group Embedded Microsystems and the Cluster of Excellence BrainLinks-BrainTools.

    View full text