# Sampling-Based Multi-Modal Multi-Robot Multi-Goal Path Planning

Source: [Sampling-Based Multi-Modal Multi-Robot Multi-Goal Path Planning](<https://www.sota2.com/research/paper/68fa7b491e209131cea878c4>)

Collection index: [llms.txt](<https://www.sota2.com/research/llms.txt>)

Data updated: 2026-04-21T05:00:04.783Z

Authors: Valentin N. Hartmann, Tirza Heinle, Yijiang Huang, Stelian Coros

Published: 2025-03-05T13:57:05.000Z

## Abstract

In many robotics applications, multiple robots are working in a shared workspace to complete a set of tasks as fast as possible. Such settings can be treated as multi-modal multi-robot multi-goal path planning problems, where each robot has to reach a set of goals. Existing approaches to this type of problem solve this using prioritization or assume synchronous task completion, and are thus neither optimal nor complete. We formalize this problem as a single centralized path planning problem and present planners that are probabilistically complete and asymptotically optimal. The planners plan in the composite space of all robots and are modifications of standard sampling-based planners with the required changes to work in our multi-modal, multi-robot, multi-goal setting. We validate the planners on a diverse range of problems including scenarios with various robots, planning horizons, and collaborative tasks such as handovers, and compare the planners against a suboptimal prioritized planner.   Videos and code for the planners and the benchmark is available at https://vhartmann.com/mrmg-planning/.

## Recorded benchmark results

A research result applies to its stated dataset, split, metric and evaluation configuration. Compare like-for-like settings, preserve the metric's unit and direction, and distinguish paper-reported results from independent reproduction. The best result recorded here is not a claim of exhaustive, current global coverage.

- [Multi-robot task and motion planning on box\_reorientation scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-box_reorientation-scenario.md>): Multi-robot task and motion planning; box\_reorientation scenario; Initialization Time (s): 3.76.

- [Multi-robot task and motion planning on box\_stacking scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-box_stacking-scenario.md>): Multi-robot task and motion planning; box\_stacking scenario; Initialization Time (s): 4.51.

- [Multi-robot task and motion planning on mobile\_wall\_four scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-mobile_wall_four-scenario.md>): Multi-robot task and motion planning; mobile\_wall\_four scenario; Initialization Time (s): 11.61.

- [Multi-robot task and motion planning on simple scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-simple-scenario.md>): Multi-robot task and motion planning; simple scenario; Initialization Time (s): 0.17.

- [Multi-robot task and motion planning on hallway scenario other](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-hallway-scenario-other.md>): Multi-robot task and motion planning; hallway scenario other; Initialization Time (s): 0.37.

- [Multi-robot task and motion planning on three\_agents scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-three_agents-scenario.md>): Multi-robot task and motion planning; three\_agents scenario; Initialization Time (s): 1.7.

- [Multi-robot task and motion planning on triple\_waypoints scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-triple_waypoints-scenario.md>): Multi-robot task and motion planning; triple\_waypoints scenario; Initialization Time (s): 0.56.

- [Multi-robot task and motion planning on welding scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-welding-scenario.md>): Multi-robot task and motion planning; welding scenario; tinit (s): 1.33.

- [Multi-robot task and motion planning on eggcartons scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-eggcartons-scenario.md>): Multi-robot task and motion planning; eggcartons scenario; tinit (s): 0.8.

- [Multi-robot task and motion planning on bottles scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-bottles-scenario.md>): Multi-robot task and motion planning; bottles scenario; Initialization Time (s): 16.

- [Multi-robot task and motion planning on box\_rearrangement scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-box_rearrangement-scenario.md>): Multi-robot task and motion planning; box\_rearrangement scenario; Initialization Time (s): 3.39.

- [Multi-robot task and motion planning on pyramid scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-pyramid-scenario.md>): Multi-robot task and motion planning; pyramid scenario; Initialization Time (s): 2.1.

- [Multi-robot task and motion planning on mobile\_strut scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-mobile_strut-scenario.md>): Multi-robot task and motion planning; mobile\_strut scenario; Initialization Time (s): 13.67.

- [Multi-robot task and motion planning on three\_robot\_truss scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-three_robot_truss-scenario.md>): Multi-robot task and motion planning; three\_robot\_truss scenario; Initialization Time (s): 3.77.

- [Multi-robot task and motion planning on spiral\_tower scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-spiral_tower-scenario.md>): Multi-robot task and motion planning; spiral\_tower scenario; Initialization Time (s): 26.37.

- [Multi-robot task and motion planning on spiral\_tower two](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-spiral_tower-two.md>): Multi-robot task and motion planning; spiral\_tower two; Initialization Time (s): 1.37.

- [Multi-robot task and motion planning on cube\_four scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-cube_four-scenario.md>): Multi-robot task and motion planning; cube\_four scenario; Initialization Time (s): 41.87.

- [Multi-robot task and motion planning on dep\_piano scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-dep_piano-scenario.md>): Multi-robot task and motion planning; dep\_piano scenario; Initialization Time (s): 0.41.

- [Multi-robot task and motion planning on dep\_box\_stacking scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-dep_box_stacking-scenario.md>): Multi-robot task and motion planning; dep\_box\_stacking scenario; Initialization Time (s): 2.93.

- [Multi-robot task and motion planning on unordered\_box\_reor. scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-unordered_box_reor-scenario.md>): Multi-robot task and motion planning; unordered\_box\_reor. scenario; Initialization Time (s): 4.8.

- [Multi-robot task and motion planning on unassigned\_tsp](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-unassigned_tsp.md>): Multi-robot task and motion planning; unassigned\_tsp; Initialization Time (s): 0.1.

- [Multi-robot task and motion planning on unassigned\_cleanup scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-unassigned_cleanup-scenario.md>): Multi-robot task and motion planning; unassigned\_cleanup scenario; Initialization Time (s): 6.62.

- [Multi-robot task and motion planning on single\_agent\_mover](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-single_agent_mover.md>): Multi-robot task and motion planning; single\_agent\_mover; Initialization Time (s): 0.09.

- [Multi-robot task and motion planning on 2d handover scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-2d-handover-scenario.md>): Multi-robot task and motion planning; 2d handover scenario; Initialization Time (s): 4.13.

- [Multi-robot task and motion planning on random\_2d scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-random_2d-scenario.md>): Multi-robot task and motion planning; random\_2d scenario; Initialization Time (s): 7.95.

- [Multi-robot task and motion planning on handover scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-handover-scenario.md>): Multi-robot task and motion planning; handover scenario; Initialization Time (s): 0.8.

- [Multi-robot task and motion planning on unordered\_bottles scenario](<https://www.sota2.com/research/sota/multi-robot-task-and-motion-planning-on-unordered_bottles-scenario.md>): Multi-robot task and motion planning; unordered\_bottles scenario; Initialization Time (s): 6.45.

## Original sources and implementation

[Original paper](<https://arxiv.org/abs/2503.03509>)

[PDF](<https://arxiv.org/pdf/2503.03509.pdf>)
