Learning-based dexterous grasping

First Plan Then Evaluate: Multi-Target Planning with Post-Planning Success Evaluation Improves Learning-Based Grasping Pipelines

Martin Matak, Mohanraj Devendran Shanthi, Karl Van Wyk, Tucker Hermans

KUKA arm with Allegro hand grasping objects from shelves, tabletop scenes, and cluttered environments.
Grasps from different shelves and table heights. The robot grasps the target object while avoiding other objects and the environment.

Abstract

Plan to the candidates first, then score what the robot can actually execute.

Autonomous multi-finger grasping is a fundamental capability in robotic manipulation. Optimization-based approaches show strong performance, but tend to be sensitive to initialization and are potentially time-consuming. As an alternative, the generator-evaluator-planner framework has been proposed. A generator generates grasp candidates, an evaluator ranks the proposed grasps, and a motion planner plans a trajectory to the highest-ranked grasp. If the planner does not find a trajectory, a new trajectory optimization is started with the next-best grasp as the target and so on.

However, executing lower-ranked grasps means a lower chance of grasp success, and multiple trajectory optimizations are time-consuming. Alternatively, relaxing the threshold for motion planning accuracy allows for easier computation of a successful trajectory but implies lower accuracy in estimating grasp success likelihood. We propose a framework that plans trajectories to a set of generated grasp targets, estimates grasp success likelihood at the terminal configuration of the planned trajectories, and executes the trajectory most likely to succeed.

Experiments show that FPTE improves over the traditional generator-evaluator-planner framework across different objects, generators, and motion planners, and successfully generalizes to novel real-world environments, including different shelves and table heights.

Approach

FPTE changes where grasp likelihood is evaluated.

The traditional pipeline ranks grasp targets before planning. FPTE instead uses generated grasps as targets for the planner, keeps every executable collision-free trajectory, then evaluates the terminal robot configuration reached by each trajectory.

  1. Generate candidates A learned generator proposes a batch of object-frame grasps from a partial point cloud encoded with Basis Point Set features.
  2. Plan to all targets A vectorized motion planner computes trajectories to all candidates in parallel while avoiding the object and environment.
  3. Evaluate terminal grasps A learned evaluator scores the grasps resulting from the planned trajectories, and the robot executes the highest-scoring trajectory.
FPTE pipeline: generator proposes target grasps, vectorized motion planner plans to all targets, evaluator ranks resulting trajectories by grasp success likelihood.
FPTE evaluates grasp success at the terminal configuration of planned trajectories rather than at the initially generated targets.

Results

Higher success across simulators, planners, generators, and real-world scenes.

In simulation, FPTE was evaluated with cuRobo and Fabrics planners, three generator architectures, 20 object shapes, and 100 table poses. The post-planning evaluator consistently improved grasp success over the traditional generate-evaluate-plan order.

In the real world, the system used a KUKA LBR4 arm with a 16 DoF Allegro hand. Across 11 novel objects and five table locations per object, FPTE reached an 80% success rate compared with 22% for the traditional pipeline.

Simulation success rate comparison across generators, motion planners, FPTE, and traditional baselines.
FPTE improves success rates across generator architectures and motion planner choices.
Ablation chart showing FPTE robustness across inverse kinematics position error thresholds.
Success remains higher for FPTE as IK solution accuracy varies; the traditional method degrades as error increases.
Evaluator average precision across different inverse kinematics position thresholds.
Evaluator average precision drops with larger IK thresholds in the traditional pipeline, but not with FPTE.

Real-world generalization

Object-centric planning transfers beyond the training setup.

The learned models were trained on simulated single-object scenes from a fixed table height. At deployment, FPTE grasps novel objects, handles different table heights, and plans around shelves, clutter, and reconstructed object meshes.

90% vs. 26% Average predicted success likelihood for executed FPTE grasps versus the traditional baseline in real-world trials.
Robot platform and real-world test objects of varying shape, size, mass, rigidity, and opaqueness.
Robot platform and the objects used for the real-world evaluation.
Generated grasp distribution around novel real-world objects.
The generator captures a diverse grasp distribution and generalizes to novel objects.
Grid of successful real-world grasps using the Allegro hand on everyday objects.
Examples of resulting real-world grasps selected by FPTE.

Evaluator

Post-planning scoring produces higher-confidence successful grasps.

The evaluator is trained on simulated positive and negative samples, including hard negatives created by perturbing successful grasps. In deployment, it scores the actual robot configurations reached by planning, making the ranking aligned with executable grasps.

Real-world grasping examples in shelves, table-height changes, and clutter.
FPTE grasps target objects while avoiding collisions in novel shelves, table heights, and multi-object environments.
Precision-recall curves for the learned evaluator in simulation and real-world settings.
Precision-recall curves show that the learned evaluator transfers from simulated training to real-world evaluation.
Predicted evaluator success likelihoods and real-world grasp outcomes.
Real-world predictions show FPTE produces higher-confidence successful grasps.