GOMP: Grasp-Optimized Motion Planning for Bin Picking

by   Jeffrey Ichnowski, et al.

Rapid and reliable robot bin picking is a critical challenge in automating warehouses, often measured in picks-per-hour (PPH). We explore increasing PPH using faster motions based on optimizing over a set of candidate grasps. The source of this set of grasps is two-fold: (1) grasp-analysis tools such as Dex-Net generate multiple candidate grasps, and (2) each of these grasps has a degree of freedom about which a robot gripper can rotate. In this paper, we present Grasp-Optimized Motion Planning (GOMP), an algorithm that speeds up the execution of a bin-picking robot's operations by incorporating robot dynamics and a set of candidate grasps produced by a grasp planner into an optimizing motion planner. We compute motions by optimizing with sequential quadratic programming (SQP) and iteratively updating trust regions to account for the non-convex nature of the problem. In our formulation, we constrain the motion to remain within the mechanical limits of the robot while avoiding obstacles. We further convert the problem to a time-minimization by repeatedly shorting a time horizon of a trajectory until the SQP is infeasible. In experiments with a UR5, GOMP achieves a speedup of 9x over a baseline planner.


page 1

page 5

page 6


GOMP-FIT: Grasp-Optimized Motion Planning for Fast Inertial Transport

High-speed motions in pick-and-place operations are critical to making r...

GOMP-ST: Grasp Optimized Motion Planning for Suction Transport

Suction cup grasping is very common in industry, but moving too quickly ...

Safely: Safe Stochastic Motion Planning Under Constrained Sensing via Duality

Consider a robot operating in an uncertain environment with stochastic, ...

Risk-Aware Motion Planning for a Limbed Robot with Stochastic Gripping Forces Using Nonlinear Programming

We present a motion planning algorithm with probabilistic guarantees for...

A Task-Motion Planning Framework Using Iteratively Deepened AND/OR Graph Networks

We present an approach for Task-Motion Planning (TMP) using Iterative De...

Reorienting Objects in 3D Space Using Pivoting

We consider the problem of reorienting a rigid object with arbitrary kno...

Toward Certifiable Motion Planning for Medical Steerable Needles

Medical steerable needles can move along 3D curvilinear trajectories to ...