Configuration Space Distance Fields for Manipulation Planning


Yiming Li, Xuemin Chi, Amirreza Razmjoo, Sylvain Calinon
Paper Website

Paper ID 131

Session 16. Manipulation

Poster Session day 4 (Friday, July 19)

Abstract: The signed distance field (SDF) is a popular implicit shape representation in robotics, providing geometric information about objects and obstacles in a form that can easily be combined with control, optimization and learning techniques. Most often, SDFs are used to represent distances in task space, which corresponds to the familiar notion of distances that we perceive in our 3D world. However, SDFs can mathematically be used in other spaces, including robot configuration spaces. For a robot manipulator, this configuration space typically corresponds to the joint angles for each articulation of the robot. While it is customary in robot planning to express which portions of the configuration space are free from collision with obstacles, it is less common to think of this information as a distance field in the configuration space. In this paper, we demonstrate the potential of considering SDFs in the robot configuration space for optimization, which we call configuration space distance field (or CDField for short). Similarly to the use of SDF in task space, CDField provides an efficient joint angle distance query and direct access to the derivatives (joint angle velocity). Most approaches split the overall computation with one part in task space followed by one part in configuration space (evaluating distances in task space and then computing actions with inverse kinematics). Instead, CDField allows the implicit structure to be leveraged by control, optimization, and learning problems in a unified manner. In particular, we propose an efficient algorithm to compute and fuse CDFields that can be generalized to arbitrary scenes. A corresponding neural CDField representation using multilayer perceptrons (MLPs) is also presented to obtain a compact and continuous representation while improving computation efficiency. We demonstrate the effectiveness of CDField with planar obstacle avoidance examples and with a 7-axis Franka Emika robot in inverse kinematics and manipulation planning tasks.