LMGN: A Unified Policy Learning Model for Last-Mile Grasp-Navigation
Authors: Xuenmin Hu, Qingxue Qian, Wei Luo, Benyi Ma, Bo Tang, Long Chen
Organizations: Hubei University, Wuhan, China · Worcester Polytechnic Institute, Worcester, MA, USA · Institute of Automation, Chinese Academy of Sciences, Beijing, China
Legged robots equipped with manipulators have shown significant potential in the fields of daily life and industry in complex environments. However, existing methods mainly focus on global navigation or manipulation independently, while overlooking the last-mile navigation problem, where the robot must jointly determine the base placement, approach direction, and grasp execution to achieve reliable object grasping, and different manipulation stages require distinct control behaviors. To address these challenges, we propose Last-Mile Grasp-Navigation (LMGN), a unified policy learning model for Quadruped robot loco-manipulation. An Explicit Distance and Directional Reachability (ED-DR) representation is first introduced to explicitly represent the features of grasp-compatible base placement and approach direction. We then develop a semantically aligned Hierarchical Mixture-of-Experts (HMoE) policy that models stage-aware behaviors across the stages of base adjustment, pre-grasp alignment and grasp execution, and object lift. Finally, a new optimization method that jointly aligns navigation and manipulation, stage-dependent expert routing, and action-level consistency is proposed to optimize the HMoE policy. Extensive experiments on the Habitat and Isaac Gym simulators demonstrate that LMGN consistently outperforms state-of-the-art methods, denoting that integrating grasp-aware reachability with stage-aware policy learning significantly improves the success rates of last-mile navigation and target grasp for robots.
Figures & tables
Figure 1: Overview of the proposed LMGN. The policy fuses grasp-guided reachability features, point-cloud observations, object pose, and proprioception, then uses a geometry-aligned hierarchical MoE policy to select stage-specific expert routes for base motion, end-effector adjustment, and gripper control.
Figure 2: ED-DR representation.
Method
GazeSR (%) ↑
GraspSR (%) ↑
VBC
69.0
52.2
HB
31.9
–
ReachMM
21.5
12.7
GAMMA
66.3
64.5
LMGN (ours)
73.9
74.8
Table 1: Comparative results with SOTA methods on Habitat. “-" indicates no reported data in the original paper.
Object
VBC
w/o HMoE
w/o ED-DR
w/o JO
LMGN (Ours)
Square Box
69.04
45.22
39.81
32.83
100.00
Long Box
31.16
7.75
12.39
9.49
100.00
Drill
30.84
9.30
17.95
28.02
76.92
Cup
61.95
60.26
41.99
39.22
97.89
Bowl
34.79
49.53
30.62
29.90
38.08
Bottle
38.28
13.44
17.80
20.54
93.90
Table 2: GazeSR (%) results of ablation study for different objects on Isaac Gym.
Object
VBC
w/o HMoE
w/o ED-DR
w/o JO
LMGN (Ours)
Square Box
23.05
56.25
39.20
2.77
57.42
Long Box
16.26
41.61
30.11
0.20
46.01
Drill
15.56
38.08
26.25
0.97
46.38
Cup
21.12
60.90
41.32
3.83
57.83
Bowl
23.23
60.37
46.71
7.81
62.85
Bottle
19.81
43.18
28.42
1.13
52.68
Table 3: GraspSR (%) results of ablation study for different objects on Isaac Gym.
Object
w/o ActionCons
w/o Reward
w/o RouteAlign
Joint optimization
Square Box
19.12
31.40
46.76
100.00
Long Box
14.15
16.50
32.63
100.00
Drill
11.17
10.40
25.81
76.92
Cup
23.00
34.47
51.03
97.89
Bowl
34.28
47.21
51.68
38.08
Bottle
12.90
18.34
32.21
93.90
Table 4: GazeSR (%) of component-wise ablation methods in joint optimization for different objects.
Object
w/o ActionCons.
w/o Reward
w/o RouteAlign
Joint optimization
Square Box
3.56
4.51
32.77
57.42
Long Box
0.05
0.15
1.68
46.01
Drill
0.23
0.43
3.50
46.38
Cup
12.80
16.24
34.09
57.83
Bowl
22.60
24.56
45.41
62.85
Bottle
0.30
0.38
9.74
52.68
Table 5: GraspSR (%) of component-wise ablation methods in joint optimization for different objects.
Object
GazeSR
GraspSR
Clear Box
82.40
41.90
Plastic Banana
75.05
46.82
Pitcher
75.02
56.83
Mean
77.49
48.52
Table 6: Success rates (%) for unseen objects.
Figure 3: Weight curves of the high-level expert routes in HMoE and some snapshots during a representative episode.
Mobile manipulation requires a robot to navigate to a target object or receptacle and then perform intended manipulation. However, reaching the vicinity of the target does not guarantee a manipulation-ready base pose, a problem known as last-mile navigation. Prior methods for last-mile navigation either rely on manual pose annotation or task-specific training, limiting their scalability to open-vocabulary settings with fine-grained spatial constraints. We propose UniLM-Nav, a unified framework for zero-shot open-vocabulary last-mile navigation. UniLM-Nav decomposes last-mile navigation into view selection, task-conditioned affordance grounding, and geometry-aware base-pose reasoning, all resolved with a shared multimodal large language model (MLLM) backend. Specifically, UniLM-Nav first selects a reference view that best captures the target object or receptacle from recently collected observations. It then grounds task-relevant affordance point in the selected view and lifts the result into the robot-centric coordinate frame. Finally, conditioned on the grounded affordance, task context, and robot geometry, it infers a manipulation-ready base pose for the robot. We evaluate UniLM-Nav on the OVMM benchmark, where it outperforms the previous state-of-the-art method, MoTo, by 3.13 percentage points. Analyses show that the components of our method are crucial to final performance, and that the choice of MLLM also has a substantial effect. We further deploy UniLM-Nav on a Unitree B2 quadruped robot with a 6-DoF Unitree Z1 manipulator, validating its applicability to real-world mobile manipulation tasks.
Zhuofan Zhang, Tianxu Wang, Guoxi Zhang +6
1Tsinghua University · 2State Key Laboratory of General Artificial Intelligence, BIGAI · 3Harbin Institute of Technology +1
Achieving precise positioning of the mobile manipulator's base is essential for successful manipulation actions that follow. Most of the RGB-based navigation systems only guarantee coarse, meter-level accuracy, making them less suitable for the precise positioning phase of mobile manipulation. This gap prevents manipulation policies from operating within the distribution of their training demonstrations, resulting in frequent execution failures. We address this gap by introducing an object-centric imitation learning framework for last-meter navigation, enabling a quadruped mobile manipulator robot to achieve manipulation-ready positioning using only RGB observations from its onboard cameras. Our method conditions the navigation policy on three inputs: goal images, multi-view RGB observations from the onboard cameras, and a text prompt specifying the target object. A language-driven segmentation module and a spatial score-matrix decoder then supply explicit object grounding and relative pose reasoning. Using real-world data from a single object instance within a category, the system generalizes to unseen object instances across diverse environments with challenging lighting and background conditions. To comprehensively evaluate this, we introduce two metrics: an edge-alignment metric, which uses ground truth orientation, and an object-alignment metric, which evaluates how well the robot visually faces the target. Under these metrics, our policy achieves 74.58% success in edge-alignment and 89.42% success in object-alignment when positioning relative to unseen target objects. These results show that precise last-meter navigation can be achieved at a category-level without depth, LiDAR, or map priors, enabling a scalable pathway toward unified mobile manipulation. Project page: https://rpm-lab-umn.github.io/category-level-last-meter-nav/
This paper addresses how to enable a humanoid robot to learn motion policies based on developmental principles and combine policies to create more sophisticated and useful behaviors. Specifically, we present an approach to (1) learning a whole-body reaching and grasping policy and (2) combining it and a standing-up and walking policy to compose a more complex policy of manipulation and locomotion: grasping, standing up, and walking. In (1), our method draws inspiration from harmonic analysis and adopts cubic harmonics as weights to represent the hand-object spatial relationship via spatial convolution. Utilizing an intra-episode finger joint decoupling curriculum based on developmental principles, a robot can autonomously learn a generalizable grasping policy without relying on external datasets or pretrained models. In (2), our method combines the grasping policy with a separately learned getting-up policy by providing both policies with their respective observation vectors and using hand-object interaction scores to determine when each policy should control which robot joints. Our results show a 93% zero-shot success rate for grasping unseen objects and a 96-100% success rate for standing up while holding the object. Our work also demonstrates that combining different policies is only effective if each policy learning happens on the same whole humanoid body even if a policy (such as for locomotion) does not seem to need all the body parts (such as fingers).
Fanxing Meng, Jing Xiao
Robotics Engineering Department, Worcester Polytechnic Institute, Worcester, MA, USA