Lazy Evaluation of Goal Specifications Guided by Motion Planning

Nowadays robotic systems are expected to share workspaces and collaborate with humans. In such collaborative environments, an important challenge is to ground or establish the correct semantic interpretation of a human request. Once such an interpretation is available, the request must be translated into robot motion commands in order to complete the desired task. It is not unusual that a human request cannot be grounded to a unique interpretation, thus leading to an ambiguous request. A simple example is to ask a robot to “put a cup on the table,” when there are multiple cups available. In order to deal with this kind of ambiguous request, we propose a delayed or lazy variable grounding. The focus of this paper is a motion planning algorithm that, given goal regions that represent different valid groundings, lazily finds a feasible path to any one valid grounding. This algorithm includes a reward-penalty strategy, which attempts to prioritize those goal regions that seem more promising to provide a solution. We validate our approach by solving requests with multiple valid alternatives in both simulation and real-world experiments.

I. Introduction

While industrial robots typically operate in controlled and structured environments, modern robotic systems are expected to conduct autonomous or semi-autonomous tasks in complex and cluttered environments. In these latter challenging scenarios, robotic systems not only use their perception capabilities to understand and safely operate through complex surroundings, but also need to take requests from and collaborate with humans.