k-Color Multi-Robot Motion Planning
Kiril Solovey
Tel-Aviv University, Israel
WAFR, 2012
* Joint work with Dan Halperin
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 1 / 23
k -Color Multi-Robot Motion Planning Kiril Solovey Tel-Aviv - - PowerPoint PPT Presentation
k -Color Multi-Robot Motion Planning Kiril Solovey Tel-Aviv University, Israel WAFR, 2012 * Joint work with Dan Halperin Kiril Solovey (TAU) k -Color Motion Planning WAFR, 2012 1 / 23 Multi-Robot Problems Classic : Every robot has start and
* Joint work with Dan Halperin
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 1 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 2 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 2 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 2 / 23
◮ Identical robots ◮ Interchangeable target positions ◮ All target positions are occupied Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 2 / 23
◮ Identical robots ◮ Interchangeable target positions ◮ All target positions are occupied Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 2 / 23
◮ Identical robots ◮ Interchangeable target positions ◮ All target positions are occupied Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 2 / 23
◮ Identical robots ◮ Interchangeable target positions ◮ All target positions are occupied Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 2 / 23
◮ Identical robots ◮ Interchangeable target positions ◮ All target positions are occupied Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 2 / 23
◮ Identical robots ◮ Interchangeable target positions ◮ All target positions are occupied
◮ Several groups of identical robots ◮ Interchangeable positions in each
group
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 2 / 23
◮ Identical robots ◮ Interchangeable target positions ◮ All target positions are occupied
◮ Several groups of identical robots ◮ Interchangeable positions in each
group
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 2 / 23
◮ Samples of amplified configurations ◮ Unlabeled problem reduced to several discrete problems Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 3 / 23
◮ Samples of amplified configurations ◮ Unlabeled problem reduced to several discrete problems
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 3 / 23
◮ First complete multi-robot algorithm ◮ Disk robots
◮ Rectangular robot in the plane is PSPACE-hard
◮ Problem decomposed into sequential subproblems
◮ Svestka & Overmars - Coordinated path planning ’98 ◮ Hirsch & Halperin - Hybrid motion planning ’02
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 4 / 23
◮ PRM - Kavraki et al. ◮ RRT - Kuffner & LaValle ◮ EST - Hsu et al.
◮ Ignores properties of the multi-robot problem ◮ Performs all operations in high-dimensional configuration space ◮ Increase in the number of robots drastically increases running time Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 5 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 6 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 6 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 7 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 7 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 7 / 23
m = 3, n = 0
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 8 / 23
m = 3, n = 1
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 8 / 23
m = 3, n = 2
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 8 / 23
m = 3, n = 3
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 8 / 23
m = 3, n = 4
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 8 / 23
m = 3, n = 5
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 8 / 23
m = 3, n = 5
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 8 / 23
m = 3, n = 5
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 8 / 23
m = 3, n = 6
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 8 / 23
m = 3, n = 7
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 8 / 23
◮ Connect pairs of positions with a path ◮ Consider the rest of the positions as obstacles ◮ Add an edge if respective path does not collide with obstacles
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 9 / 23
◮ Connect pairs of positions with a path ◮ Consider the rest of the positions as obstacles ◮ Add an edge if respective path does not collide with obstacles
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 9 / 23
◮ Connect pairs of positions with a path ◮ Consider the rest of the positions as obstacles ◮ Add an edge if respective path does not collide with obstacles
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 9 / 23
◮ Connect pairs of positions with a path ◮ Consider the rest of the positions as obstacles ◮ Add an edge if respective path does not collide with obstacles
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 9 / 23
◮ Connect pairs of positions with a path ◮ Consider the rest of the positions as obstacles ◮ Add an edge if respective path does not collide with obstacles
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 9 / 23
◮ Connect pairs of positions with a path ◮ Consider the rest of the positions as obstacles ◮ Add an edge if respective path does not collide with obstacles
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 9 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 10 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 10 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 10 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 10 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 10 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 10 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 11 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 11 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 11 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 11 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 11 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 12 / 23
1 Preprocess: 2 Query(S, T): Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 13 / 23
1 Preprocess: ◮ Sample pumped configurations V1, V2, . . . ◮ Generate respective pebble graphs G1, G2, . . . ◮ Connect pairs of graphs 2 Query(S, T): Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 13 / 23
1 Preprocess: ◮ Sample pumped configurations V1, V2, . . . ◮ Generate respective pebble graphs G1, G2, . . . ◮ Connect pairs of graphs 2 Query(S, T): ◮ Create the start and target pebble graphs GS and GT ◮ Connect to other pebble graphs ◮ Retrieve path Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 13 / 23
1 Preprocess: ◮ Sample pumped configurations V1, V2, . . . ◮ Generate respective pebble graphs G1, G2, . . . ◮ Connect pairs of graphs 2 Query(S, T): ◮ Create the start and target pebble graphs GS and GT ◮ Connect to other pebble graphs ◮ Retrieve path Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 13 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 14 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 14 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 14 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 14 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 15 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 15 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 15 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 15 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 15 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 15 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 15 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 15 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 15 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 15 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 15 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 15 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 15 / 23
1 Preprocess: ◮ Sample pumped configurations V1, V2, . . . ◮ Generate respective pebble graphs G1, G2, . . . ◮ Connect pairs of graphs 2 Query(S, T): ◮ Create the start and target pebble graphs GS and GT ◮ Connect to other pebble graphs ◮ Retrieve path Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 16 / 23
◮ Sample a pumped configuration ◮ Generate geometric graph
◮ Pumped configuration in different colors do not overlap ◮ Paths do no collide with stationary robots from other color
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 17 / 23
◮ Sample a pumped configuration ◮ Generate geometric graph
◮ Pumped configuration in different colors do not overlap ◮ Paths do no collide with stationary robots from other color
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 17 / 23
◮ Sample a pumped configuration ◮ Generate geometric graph
◮ Pumped configuration in different colors do not overlap ◮ Paths do no collide with stationary robots from other color
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 17 / 23
◮ Sample a pumped configuration ◮ Generate geometric graph
◮ Pumped configuration in different colors do not overlap ◮ Paths do no collide with stationary robots from other color
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 17 / 23
◮ Sample a pumped configuration ◮ Generate geometric graph
◮ Pumped configuration in different colors do not overlap ◮ Paths do no collide with stationary robots from other color
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 17 / 23
◮ CGAL for local planner and collision detection
◮ Varying number of robots and colors
◮ OOPSMP’s implementation of PRM for fully-colored inputs ◮ Our implementation of PRM variant for k-color
◮ When the number of robots ≥ 3 Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 18 / 23
Unlabeled (23.2s) 2-Color (20.3s) 4-Color (32.9s) Fully-Colored: Decoupled (213.7s) Fully-Colored: Coupled (1.9s) Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 19 / 23
Unlabeled (23.2s) 2-Color (20.3s) 4-Color (32.9s) Fully-Colored: Decoupled (213.7s) Fully-Colored: Coupled (1.9s) Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 19 / 23
Unlabeled (23.2s) 2-Color (20.3s) 4-Color (32.9s) Fully-Colored: Decoupled (213.7s) Fully-Colored: Coupled (1.9s) Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 19 / 23
Unlabeled (23.2s) 2-Color (20.3s) 4-Color (32.9s) Fully-Colored: Decoupled (213.7s) Fully-Colored: Coupled (1.9s) Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 19 / 23
Unlabeled (23.2s) 2-Color (20.3s) 4-Color (32.9s) Fully-Colored: Decoupled (213.7s) Fully-Colored: Coupled (1.9s) Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 19 / 23
Unlabeled (23.2s) 2-Color (20.3s) 4-Color (32.9s) Fully-Colored: Decoupled (213.7s) Fully-Colored: Coupled (1.9s) Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 19 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 20 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 21 / 23
Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 22 / 23
◮ Sampling-based ◮ Tailor-made for multi-robots
◮ Pumped configurations ◮ Pebble graphs Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 22 / 23
◮ Sampling-based ◮ Tailor-made for multi-robots
◮ Pumped configurations ◮ Pebble graphs
◮ Collision detector ◮ Local planner
◮ Only interactions between pairs of robots are considered Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 22 / 23
◮ Sampling-based ◮ Tailor-made for multi-robots
◮ Pumped configurations ◮ Pebble graphs
◮ Collision detector ◮ Local planner
◮ Only interactions between pairs of robots are considered
◮ Applicable to many robots ◮ Works well even for the fully-colored case Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 22 / 23
1 Probabilistic completeness ◮ Seems possible with a few modifications (?) ◮ Work in progress on a variant of KPUMP that is complete Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 23 / 23
1 Probabilistic completeness ◮ Seems possible with a few modifications (?) ◮ Work in progress on a variant of KPUMP that is complete 2 Path optimization ◮ Connect positions in pebble graphs with RRT ◮ Reduce length of paths induced by pebble problems Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 23 / 23
1 Probabilistic completeness ◮ Seems possible with a few modifications (?) ◮ Work in progress on a variant of KPUMP that is complete 2 Path optimization ◮ Connect positions in pebble graphs with RRT ◮ Reduce length of paths induced by pebble problems 3 Hardness of Unlabeled and k-Color ◮ Unlabeled “warehouse problem” is trivial! Kiril Solovey (TAU) k-Color Motion Planning WAFR, 2012 23 / 23