← Qihang Li

SC-BPE · Preprint

Skeleton-Conditioned Base Placement Evaluation for Long-Horizon Mobile Manipulation

Qihang Li1 Yixuan Huang2 Tom Silver2 Peng Gao1

1 North Carolina State University2 Princeton University

Overview

Mobile manipulators usually pick a base pose for the next skill and reposition for the one after. Often a single pose could support the whole task, but finding it is hard: grasps and arm motions are not yet decided, and early choices change what later skills can reach.

SC-BPE is a learned evaluator that scores a base pose together with a plan skeleton, the ordered Pick and Place actions with their objects and regions. A task and motion planner then refines the highest-scoring pairs first, keeping the base fixed for the whole sequence.

Swapping two objects between occupied trays: where should the robot stand to complete the whole task, and how base suitability depends on the temporary buffer
Swapping two objects between occupied trays needs a temporary location. Which base poses work depends on that choice (the two skeletons at right differ only in the buffer). Click to enlarge.

TL;DR: Predicts whether a whole plan can work from one base pose, so planning tries promising bases first and saves time.

Method

The evaluator scores a base pose together with the whole plan skeleton, so the same symbolic plan can rank differently from different bases.

SC-BPE overview: inference, training, and network

Overview

Given a task goal and an RGB-D observation, a symbolic planner proposes plan skeletons. SC-BPE scores each skeleton together with a sampled base pose, and the TAMP planner refines the most promising pairs first, with the base fixed for the whole sequence.

Click the figure to enlarge it.

Results

With one fixed base pose, SC-BPE plans faster than random ordering of the same candidates, its scores follow how the plan changes the best base, and it is competitive with methods that move the base between skills.

Tasks

SC-BPE task 1: shelf placement
Task 1: a TidyBot transfers objects from a table to a designated shelf level without overlap (2 to 5 objects).

Compared methods

SC-BPE (ours)
Ranks complete skeleton–base pairs by surrogate score; the base stays fixed.
Random Ranking
The same pairs in random order, with the same candidate evaluation.
Per-Skill Rebase
Geometric base selection, and the base may change between skills.
Atomic-BPE Rebase
Learned scores for the current skill only, with rebasing between skills.

Each setting uses 29 held-out scenes; ON means N objects.

1. Does ranking make planning faster?

Yes. SC-BPE has higher success and lower planning time than random ordering of the same candidates in all eight settings. On Task 2–O3 it solves all 29 scenes (random: 28.3%), and its first attempt already succeeds in 86.2% of scenes (random: 2.1%).

Task 2–O3: cumulative success versus (a) candidate attempts and (b) planning time, on 29 test scenes (60 s per candidate, 180 s per scene).

Cumulative scene success versus planning attempts and planning time on Task 2-O3

2. Do the scores reflect the plan?

Yes. The three skeletons below differ only in the temporary buffer, yet get different score maps. Successful base positions sit toward the left for B1, the right for B3, and a broader central region for B2, and the high-score regions follow.

Surrogate score maps over sampled base positions for three skeletons that differ only in the temporary buffer
Task 2–O3. Maps show the maximum surrogate score over five headings. Circles and crosses mark base positions with at least one and no successful candidate evaluation; stars mark predicted maxima. On a phone, swipe sideways to see the whole figure.

3. How does a fixed base compare with rebasing?

It is competitive. SC-BPE has higher success and lower planning time than both rebasing methods on Task 1. On Task 2–O4 it ties Per-Skill Rebase at 89.7% success while cutting mean planning time from 124.4 to 75.0 s. Rebasing can win when moving helps: on Task 3–O2, Per-Skill Rebase reaches 96.6% success against 86.2%.

SettingSC-BPE (ours)Random RankingPer-Skill RebaseAtomic-BPE Rebase
SR ↑Plan ↓Exec ↓SR ↑Plan ↓Exec ↓SR ↑Plan ↓Exec ↓SR ↑Plan ↓Exec ↓
Task 1 · O2100.08.927.586.421.127.593.120.331.593.119.929.4
Task 1 · O3100.027.339.283.843.439.086.241.545.989.742.042.3
Task 1 · O4100.046.054.980.691.052.572.493.059.779.388.054.8
Task 1 · O582.8121.265.969.4162.964.755.2163.272.469.0146.367.3
Task 2 · O3100.026.429.328.3147.130.386.272.931.689.777.631.9
Task 2 · O489.775.047.949.0211.849.289.7124.454.082.8128.651.2
Task 3 · O286.252.434.922.1108.134.896.646.938.558.675.836.5
Task 3 · O351.7127.954.08.7173.352.144.8145.961.431.0157.756.1

Swipe sideways to see all columns.

Hover (or tap) a method name for its definition and setting. SR: success rate (%). Plan: mean planning time over all scenes, including failures (s). Exec: mean execution time over successful scenes (s). Bold marks the best result and underline the second best when the best is unique. In each setting, all methods share the same scenes, goal checks, and time budget.

Real-to-sim-to-real demo

A physical mobile manipulator transfers two bananas from a coffee table onto a notebook on the sofa.

The evaluator is trained only on labels from a simulated reconstruction of the scene. Visual servoing corrects errors during execution.

How the demo works
(a) real-world navigation, (b) simulation navigation, (c) simulation trajectory, (d) real-world execution
Orange: placement trajectory. Cyan: post-placement retreat.
  1. The room is reconstructed in simulation from real captures. Candidate outcomes collected there are the labels for training the evaluator.
  2. SC-BPE ranks skeleton–base pairs, and the selected manipulation base becomes the navigation goal.
  3. On the robot, point-cloud registration (small_gicp) localizes it as it approaches the base (a). The same approach is replayed in simulation (b), and the refined plan gives the manipulation trajectory (c).
  4. The robot follows the simulated action sequence. Once the target is detected, visual servoing corrects accumulated and sim-to-real errors during execution (d).

Contact: [email protected], [email protected]