Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path...
-
Upload
brendan-cunningham -
Category
Documents
-
view
214 -
download
0
Transcript of Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path...
![Page 1: Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path Planning.](https://reader030.fdocuments.us/reader030/viewer/2022032702/56649ceb5503460f949b637a/html5/thumbnails/1.jpg)
Roland Geraerts and Mark Overmars
ICRA 2007
The Corridor Map Method:Real-Time High-Quality Path Planning
![Page 2: Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path Planning.](https://reader030.fdocuments.us/reader030/viewer/2022032702/56649ceb5503460f949b637a/html5/thumbnails/2.jpg)
Previous work
• Potential field planners – Flexible– Slow / local minima
• Probabilistic Roadmap Methods– Fast – Ugly paths– Output: fixed paths in response to a query
• Predictable motions • Lacks flexibility when environment changes
![Page 3: Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path Planning.](https://reader030.fdocuments.us/reader030/viewer/2022032702/56649ceb5503460f949b637a/html5/thumbnails/3.jpg)
Our planner
• Requirements– High-quality paths– Flexible– Extremely fast
• Current limitations– The robot is modeled by a disc– Experiments with only 2D problems
![Page 4: Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path Planning.](https://reader030.fdocuments.us/reader030/viewer/2022032702/56649ceb5503460f949b637a/html5/thumbnails/4.jpg)
The Corridor Map Method
• Construction phase (off-line)– Create a system of collision-free corridors for
the static obstacles
Graph Corridor map: graph + clearance
![Page 5: Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path Planning.](https://reader030.fdocuments.us/reader030/viewer/2022032702/56649ceb5503460f949b637a/html5/thumbnails/5.jpg)
The Corridor Map Method
• Query phase (on-line)– Extract corridor for given start and goal– Extract path by following attraction point
Corridor: backbone path + clearance
Query Path
![Page 6: Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path Planning.](https://reader030.fdocuments.us/reader030/viewer/2022032702/56649ceb5503460f949b637a/html5/thumbnails/6.jpg)
The Corridor Map Method
• Attraction point α(x)– Robot’s location: x– Robot’s goal: g– Radius circle: r– Euclidean distance: d
• Path is obtained by integration over time while updating the velocity, position, and attraction point of the robot
• For other behavior: locally adjust robot’s path by adding forces
α(x)
x
g
r
d
![Page 7: Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path Planning.](https://reader030.fdocuments.us/reader030/viewer/2022032702/56649ceb5503460f949b637a/html5/thumbnails/7.jpg)
Avoiding obstacles
• Adding forces– For each obstacle,
add repulsive force to the robot
• Creating a sub-corridor– For each obstacle, move
backbone path locally and recompute clearance info
![Page 8: Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path Planning.](https://reader030.fdocuments.us/reader030/viewer/2022032702/56649ceb5503460f949b637a/html5/thumbnails/8.jpg)
Creating shorter paths
• Attraction point α(x) corresponds to point B[t] on the backbone path
• Add additional valid attraction point α(x, Δt), corresponding to point B[t + Δt]
• Valid means: x can see point B[t + Δt]
α(x, 0.00) α(x, 0.05) α(x, 0.10) α(x, 0.25)
![Page 9: Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path Planning.](https://reader030.fdocuments.us/reader030/viewer/2022032702/56649ceb5503460f949b637a/html5/thumbnails/9.jpg)
Experimental setup
• Single path planning system• Created in Visual C++, Windows XP• 2.66 GHz P4 processor, 1 GB memory• Each experiment was run 100 times• Statistics: running time of query phase, CPU load• Input graphs created using
– “Creating High-quality Roadmaps for Motion Planning in Virtual Environments“- IROS 2006
– Environments were discretized: 100x100 cells
![Page 10: Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path Planning.](https://reader030.fdocuments.us/reader030/viewer/2022032702/56649ceb5503460f949b637a/html5/thumbnails/10.jpg)
Experimental setup
• Maze • Field
1.6 seconds 20 seconds
![Page 11: Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path Planning.](https://reader030.fdocuments.us/reader030/viewer/2022032702/56649ceb5503460f949b637a/html5/thumbnails/11.jpg)
Experiments – Smooth paths
• Maze
Query time: 2.41 ms
CPU load: 0.026%
• Field
Query time: 0.84 ms
CPU load: 0.029%
![Page 12: Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path Planning.](https://reader030.fdocuments.us/reader030/viewer/2022032702/56649ceb5503460f949b637a/html5/thumbnails/12.jpg)
Experiments – Obstacles
• Maze: adding forces
Query time: 7.0—9.0 ms
CPU load: 0.05—0.06%
• Maze: sub-corridor
Query time: 3.0—13.6 ms
CPU load: 0.025—0.10%
![Page 13: Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path Planning.](https://reader030.fdocuments.us/reader030/viewer/2022032702/56649ceb5503460f949b637a/html5/thumbnails/13.jpg)
Experiments – Obstacles
• Maze
![Page 14: Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path Planning.](https://reader030.fdocuments.us/reader030/viewer/2022032702/56649ceb5503460f949b637a/html5/thumbnails/14.jpg)
Experiments – Obstacles
• Field: adding forces
Query time: 2.0—2.3 ms
CPU load: 0.05—0.05%
• Field: sub-corridor
Query time: 1.0—7.0 ms
CPU load: 0.03—0.16%
![Page 15: Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path Planning.](https://reader030.fdocuments.us/reader030/viewer/2022032702/56649ceb5503460f949b637a/html5/thumbnails/15.jpg)
Experiments – Obstacles
• Field
![Page 16: Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path Planning.](https://reader030.fdocuments.us/reader030/viewer/2022032702/56649ceb5503460f949b637a/html5/thumbnails/16.jpg)
Experiments – Short paths
• Maze: Δt = 0
Query time: 2.41 ms
CPU load: 0.026%
• Maze: Δt = 0.2
Query time: 9.64 ms
CPU load: 0.104%
![Page 17: Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path Planning.](https://reader030.fdocuments.us/reader030/viewer/2022032702/56649ceb5503460f949b637a/html5/thumbnails/17.jpg)
Experiments – Short paths
• Maze
![Page 18: Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path Planning.](https://reader030.fdocuments.us/reader030/viewer/2022032702/56649ceb5503460f949b637a/html5/thumbnails/18.jpg)
Experiments – Short paths
• Field: Δt = 0
Query time: 0.84 ms
CPU load: 0.029%
• Field: Δt = 0.2
Query time: 3.36 ms
CPU load: 0.116%
![Page 19: Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path Planning.](https://reader030.fdocuments.us/reader030/viewer/2022032702/56649ceb5503460f949b637a/html5/thumbnails/19.jpg)
Experiments – Short paths
• Field
![Page 20: Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path Planning.](https://reader030.fdocuments.us/reader030/viewer/2022032702/56649ceb5503460f949b637a/html5/thumbnails/20.jpg)
Conclusions
• The CMM produces high-quality paths– Natural paths: smooth, short / large clearance
• The CMM is flexible– Paths are locally adjustable
• The CMM is fast– CPU load < 0.1%
![Page 21: Roland Geraerts and Mark Overmars ICRA 2007 The Corridor Map Method: Real-Time High-Quality Path Planning.](https://reader030.fdocuments.us/reader030/viewer/2022032702/56649ceb5503460f949b637a/html5/thumbnails/21.jpg)
Future work
• Extend experimentswith 2½D / 3D problems
• Study applications– Planning of a group– Steering a camera– Alternative routes– Tactical planning