Section 42.7: Mobile Manipulation: Base, Arm, Perception, And Recovery

"A mobile manipulator is a negotiation between reachability and route planning."

A Whole-Body Systems Notebook
Illustration for Section 42.7: Mobile Manipulation: Base, Arm, Perception, And Recovery
Figure 42.7A: A mobile manipulation loop must co-design route choice, base staging, arm reachability, and recovery rather than treating grasping as a final afterthought.
Big Picture

Mobile manipulation couples navigation, perception, reachability, grasping, and recovery into one long-horizon control problem. The base pose is part of the grasp plan, not just a precondition for it.

This section explains how base position, arm kinematics, visibility, and recovery policies interact in whole-body manipulation. Good mobile manipulators plan for navigation and grasping together, not as isolated modules.

It synthesizes earlier material on navigation, mapping, manipulation, and recovery into one application-grade system loop with explicit evidence artifacts.

Action Is The Test

If the base is staged poorly, even a perfect arm policy will look stupid. Whole-body success depends on choosing poses that preserve visibility, reachability, and recovery margin simultaneously.

Loop diagram for Section 42.7Sensemap, targetStagebase and armExecutewhole-body taskRecoverretreat and retry
Figure 42.7.1: A mobile manipulation loop must co-design route choice, base staging, arm reachability, and recovery rather than treating grasping as a final afterthought.

Theory

The central object is a coupled cost over base pose, arm configuration, visibility, collision risk, and task progress. Local arm planning cannot be optimal if the base pose destroys reachability or line of sight.

This coupling is why mobile manipulation is a natural benchmark for embodied AI. It forces a policy or planner to reason across spatial scales and across multiple failure channels in one episode.

$$ (q_b^\star, q_a^\star) = \arg\min_{q_b, q_a} C_{\text{route}}(q_b)+C_{\text{reach}}(q_b,q_a)+C_{\text{view}}(q_b)+C_{\text{risk}}(q_b,q_a) $$

Mechanism

The robot builds a semantic map, chooses candidate base poses that preserve arm reachability and visibility, executes a staged manipulation plan, and routes to retreat or reobserve when local evidence disagrees with the global map. A good evidence artifact contains route, base pose, arm plan, and recovery branch together.

Algorithm: Whole-Body Staging Score
  1. Generate candidate base poses near the target region and reject ones with poor reachability or visibility.
  2. Plan a local whole-body sequence: base settle, arm approach, contact action, and retreat corridor.
  3. Refresh local perception after base arrival before committing the arm plan.
  4. If the grasp or contact fails, retreat to a safe standoff pose before replanning.

Worked Example

# Score candidate base poses for reachability, view, and risk.
candidates = [
    {"pose": "b1", "reach": 0.92, "view": 0.55, "risk": 0.20},
    {"pose": "b2", "reach": 0.80, "view": 0.90, "risk": 0.10},
    {"pose": "b3", "reach": 0.95, "view": 0.30, "risk": 0.35},
]

scores = []
for c in candidates:
    score = round(0.5 * c["reach"] + 0.4 * c["view"] - 0.6 * c["risk"], 3)
    scores.append((c["pose"], score))

scores.sort(key=lambda row: row[1], reverse=True)
print(scores)
[('b2', 0.7), ('b1', 0.56), ('b3', 0.385)]
Code Fragment 42.7.1 illustrates the core mobile-manipulation tradeoff: the best base pose balances reachability, viewpoint quality, and risk rather than maximizing any one in isolation.

Expected output: The expected ranking prefers the slightly less reachable pose with much better visibility and lower risk. That is often the right whole-body decision in homes, warehouses, and service settings.

Library Shortcut

Nav2, MoveIt, BehaviorTree.CPP, Habitat 3.0, ManiSkill, BEHAVIOR-1K, and Mobile ALOHA provide much of the plumbing. The hard systems work is choosing the joint evidence schema that makes navigation and manipulation failures comparable.

Practical Recipe

  1. Score base poses with visibility and retreat feasibility, not just arm reachability.
  2. Refresh local perception after arriving at the base pose because small route errors matter near contact.
  3. Reserve space for retreat and human-safe recovery before the arm starts moving.
  4. Log route, base pose, arm plan, and failure branch in one artifact.
  5. Benchmark on tasks where the first base pose is intentionally suboptimal so recovery is exercised.
Common Failure Mode

Treating mobile manipulation as navigation followed by grasping usually creates hidden dead ends. The base may arrive in a place where the target is visible but not reachable, or reachable but unsafe to recover from.

Practical Example

Household robots opening cabinets, carrying dishes, or picking objects from cluttered floors routinely need to re-stage the base to obtain a better wrist approach and a safer retreat corridor.

Memory Hook

A mobile manipulator can absolutely reach the wrong place with stunning confidence. That is why the base pose deserves as much suspicion as the grasp pose.

Research Frontier

Frontier systems combine foundation-model perception, whole-body planning, and large-scale household simulation. The lasting contribution is still an evidence loop that reveals why a task failed across route, staging, contact, and recovery layers.

Self Check

Could you justify your chosen base pose using reachability, visibility, and retreat margin, or did the robot simply stop where navigation happened to end?

Mobile manipulation is a clean example of multi-timescale reasoning. Global route planning runs over meters and seconds, while contact control runs over centimeters and milliseconds. Whole-body success depends on passing the right abstractions between those scales.

It is also a useful place to teach coupled evaluation. A navigation benchmark and a grasp benchmark can both look strong while the combined system fails because the interfaces between them were never optimized together.

Practical Tool Choices For This Section
Tool or LibraryRole in the TopicBuilder Advice
Nav2Base navigation and route executionUse costmaps and recovery behaviors that leave manipulation staging space.
MoveIt 2Arm planning after stagingUse it to evaluate reachability and contact-free arm motion from each base pose.
BehaviorTree.CPPWhole-body task routingHelpful for retry logic that spans route, stage, and grasp failures.
Mini Lab

Construct a mobile-manipulation benchmark with three candidate base poses per task. Show that your system chooses a pose with better whole-body success than a nearest-goal heuristic.

When a task fails, ask whether the route, the base pose, the local perception refresh, the arm plan, or the retreat branch first violated its contract. Mobile manipulation only becomes debuggable once those labels stay separate.

Section References

Nav2 documentation

Official navigation stack reference for staged base motion and recovery.

Habitat 3.0

Simulator for interactive embodied tasks with navigation and manipulation.

Mobile ALOHA

Mobile bimanual manipulation system showing whole-body teleoperation and data-driven control.

Key Takeaway

Mobile manipulation is a whole-body coordination problem whose success depends as much on base staging and recovery margin as on arm control.

Exercise 42.7.1

Design a base-pose scoring function for a mobile manipulator that must pick an object from a shelf and retreat through a narrow aisle. Include one term for visibility and one for retreat safety.