The Voronoi Diagram David Johnson. Voronoi Diagram Creates a roadmap that maximizes clearance –Can be difficult to compute –We saw an approximation in.

Slides:



Advertisements
Similar presentations
Configuration Space. Recap Represent environments as graphs –Paths are connected vertices –Make assumption that robot is a point Need to be able to use.
Advertisements

Problems in curves and surfaces M. Ramanathan Problems in curves and surfaces.
Complete Motion Planning
Motion Planning for Point Robots CS 659 Kris Hauser.
 Distance Problems: › Post Office Problem › Nearest Neighbors and Closest Pair › Largest Empty and Smallest Enclosing Circle  Sub graphs of Delaunay.
Computational Geometry II Brian Chen Rice University Computer Science.
By Lydia E. Kavraki, Petr Svestka, Jean-Claude Latombe, Mark H. Overmars Emre Dirican
Slide 1 Robot Lab: Robot Path Planning William Regli Department of Computer Science (and Departments of ECE and MEM) Drexel University.
Visibility Graph and Voronoi Diagram CS Tutorial.
Sampling Strategies for PRMs modified from slides of T.V.N. Sri Ram.
University of Amsterdam Search, Navigate, and Actuate - Quantitative Navigation Arnoud Visser 1 Search, Navigate, and Actuate Quantative Navigation.
Medial axis computation of exact curves and surfaces M. Ramanathan Department of Engineering Design, IIT Madras Medial object.
By Groysman Maxim. Let S be a set of sites in the plane. Each point in the plane is influenced by each point of S. We would like to decompose the plane.
4/15/2017 Using Gaussian Process Regression for Efficient Motion Planning in Environments with Deformable Objects Barbara Frank, Cyrill Stachniss, Nichola.
Discrete Geometry Tutorial 2 1
DESIGN OF A GENERIC PATH PATH PLANNING SYSTEM AILAB Path Planning Workgroup.
Visibility Computations: Finding the Shortest Route for Motion Planning COMP Presentation Eric D. Baker Tuesday 1 December 1998.
Randomized Motion Planning for Car-like Robots with C-PRM Guang Song and Nancy M. Amato Department of Computer Science Texas A&M University College Station,
2. Voronoi Diagram 2.1 Definiton Given a finite set S of points in the plane , each point X of  defines a subset S X of S consisting of the points of.
Computational Geometry and Spatial Data Mining
1 Last lecture  Configuration Space Free-Space and C-Space Obstacles Minkowski Sums.
Randomized Planning for Short Inspection Paths Tim Danner and Lydia E. Kavraki 2000 Presented by David Camarillo CS326a: Motion Planning, Spring
By Dor Lahav. Overview Straight Skeletons Convex Polygons Constrained Voronoi diagrams and Delauney triangulations.
1 Single Robot Motion Planning - II Liang-Jun Zhang COMP Sep 24, 2008.
1 Last lecture  Path planning for a moving Visibility graph Cell decomposition Potential field  Geometric preliminaries Implementing geometric primitives.
UMass Lowell Computer Science Advanced Algorithms Computational Geometry Prof. Karen Daniels Spring, 2007 Chapter 5: Voronoi Diagrams Wednesday,
1 GEOMETRIE Geometrie in der Technik H. Pottmann TU Wien SS 2007.
CS 326A: Motion Planning Configuration Space. Motion Planning Framework Continuous representation (configuration space and related spaces + constraints)
CS 326A: Motion Planning Criticality-Based Motion Planning: Target Finding.
Randomized Planning for Short Inspection Paths Tim Danner Lydia E. Kavraki Department of Computer Science Rice University.
Randomized Motion Planning for Car-like Robots with C-PRM Guang Song, Nancy M. Amato Department of Computer Science Texas A&M University College Station,
City College of New York 1 Dr. John (Jizhong) Xiao Department of Electrical Engineering City College of New York Robot Motion Planning.
CS 326 A: Motion Planning robotics.stanford.edu/~latombe/cs326/2003/index.htm Configuration Space – Basic Path-Planning Methods.
Robot Motion Planning Bug 2 Probabilistic Roadmaps Bug 2 Probabilistic Roadmaps.
CS 326A: Motion Planning Basic Motion Planning for a Point Robot.
Chapter 5: Path Planning Hadi Moradi. Motivation Need to choose a path for the end effector that avoids collisions and singularities Collisions are easy.
1 University of Denver Department of Mathematics Department of Computer Science.
A Navigation Mesh for Dynamic Environments Wouter G. van Toll, Atlas F. Cook IV, Roland Geraerts CASA 2012.
Visibility Graphs and Cell Decomposition By David Johnson.
© Manfred Huber Autonomous Robots Robot Path Planning.
Planning Near-Optimal Corridors amidst Obstacles Ron Wein Jur P. van den Berg (U. Utrecht) Dan Halperin Athens May 2006.
Robotics Chapter 5 – Path and Trajectory Planning
Shape Analysis and Retrieval Structural Shape Descriptors Notes courtesy of Funk et al., SIGGRAPH 2004.
Computational Geometry Piyush Kumar (Lecture 10: Robot Motion Planning) Welcome to CIS5930.
Path Planning for a Point Robot
Probabilistic Roadmaps for Path Planning in High-Dimensional Configuration Spaces (1996) L. Kavraki, P. Švestka, J.-C. Latombe, M. Overmars.
Digital Image Processing CCS331 Relationships of Pixel 1.
CS B659: Principles of Intelligent Robot Motion Configuration Space.
Extended Grassfire Transform on Medial Axes of 2D Shapes
Lecture 7 : Point Set Processing Acknowledgement : Prof. Amenta’s slides.
Voronoi Diagram (Supplemental)
Introduction to Motion Planning
UNC Chapel Hill M. C. Lin Introduction to Motion Planning Applications Overview of the Problem Basics – Planning for Point Robot –Visibility Graphs –Roadmap.
Configuration Spaces for Translating Robots Minkowsi Sum/Difference David Johnson.
Robotics Chapter 5 – Path and Trajectory Planning
Autonomous Robots Robot Path Planning (3) © Manfred Huber 2008.
UNC Chapel Hill M. C. Lin Delaunay Triangulations Reading: Chapter 9 of the Textbook Driving Applications –Height Interpolation –Constrained Triangulation.
Two Finger Caging of Concave Polygon Peam Pipattanasomporn Advisor: Attawith Sudsang.
Motion Planning Howie CHoset. Assign HW Algorithms –Start-Goal Methods –Map-Based Approaches –Cellular Decompositions.
Autonomous Robots Robot Path Planning (2) © Manfred Huber 2008.
NUS CS 5247 David Hsu Configuration Space. 2 What is a path?
Real-Time Configuration Space Transforms for Obstacle Avoidance Wyatt S. Newman and Michael S. Branicky.
Lecture 9 : Point Set Processing
How do I get there? Roadmap Methods Visibility Graph Voronoid Diagram.
CS 326A: Motion Planning Probabilistic Roadmaps for Path Planning in High-Dimensional Configuration Spaces (1996) L. Kavraki, P. Švestka, J.-C. Latombe,
Mathematics & Path Planning for Autonomous Mobile Robots
Last lecture Configuration Space Free-Space and C-Space Obstacles
Path Planning in Discrete Sampled Space
Planning.
Classic Motion Planning Methods
Presentation transcript:

The Voronoi Diagram David Johnson

Voronoi Diagram Creates a roadmap that maximizes clearance –Can be difficult to compute –We saw an approximation in Medial Axis PRM

Voronoi region for points Points are “sites” Voronoi diagram of points s in set S –Partition of space into regions VR(s) such that for all points [x,y] in VR(s), d([x,y],s) < d([x,y],t) for all t in S not = s –Cell boundary where D(Obs1) = D(Obs2) for the two closest obstacles

Examples Voronoi Applet Voronoi art Different metrics are possible –ManhattanManhattan

Voronoi Roadmap properties Accessibility –Follow distance gradient away from obstacle to the cell boundary Departability –Same, but follow gradient in Connectivity –Free space smoothly deforms onto the GVD, topology is preserved

Computing Voronoi regions The Voronoi cell boundaries are composed of bisectors of sites. Bisector B(s,t) is locus of points d(p,s) = d(p,t) Bisector of two points is what shape?

Another view Prairie fire analogy –Set each site on fire –Fire burns outwards at same rate Could use something like a wavefront algorithm to approximate this Other approaches –Fortune’s algorithmFortune’s algorithm –Incremental construction

This is analogous to

GPU computation Use graphics for fast 2D Voronoi diagram Path planning example Potential field example Voronoi2D.exe

Extend to Generalized Sites Generalized Voronoi Diagram (GVD) –Sites are not just points –Everything else is the same

Generalized Voronoi Diagram Edges formed based on three types of interaction: Edge-Edge Edge-Vertex Vertex-Vertex

Polygonal Boundaries

Wave propagation idea generalizes

3D bisector typeportion of point – pointplane point – edgeparabolic cylinder point – triangleparaboloid edge – edgehyperbolic paraboloid edge – triangleparabolic cylinder triangle - triangle plane

3D Gets Complex

Generalized Voronoi Diagram Computation Analytic BoundaryDiscretize SitesDiscretize Space Exact Algorithm Approximate Algorithms

Exact Computation for Polylines Diagram is composed of segments or portions of parabolas Many robustness issues (CGAL)

GVD Approximation – Method 1 Approximation – Discretize Obstacles –Convert each obstacle into a set of points by selecting samples along boundaries. –Compute regular Voronoi diagram on resulting point sets. –Will produce some diagram edges that are not traversable. Must prevent travel along these portions. –Can be slow to compute, depending on samples. This is no longer a curve. Yellow portions are not traversable since they are inside the obstacle.

GVD Approximation – Method 1 Approximation – Discretize Obstacles (continued) –Consider computing the GVD for the following example:

Approximation – Discretize Obstacles (continued) –Compute sample points along obstacle border. GVD Approximation – Method 1

Approximation – Discretize Obstacles (continued) –Here is the Voronoi Diagram for the point set: GVD Approximation – Method 1

Approximation – Discretize Obstacles (continued) –Can discard (ignore) all edges of GVD that are defined by two consecutive points from the same obstacle: Can also discard all edges that lie completely interior to any obstacle (i.e., green ones here).

Approximation – Discretize Obstacles (continued) –Resulting GVD edges can be searched for a path from start to goal (e.g., store GVD as graph, run Dijkstra’s shortest path algorithm) GVD Approximation – Method 1

GVD Approximation – Method 2 Approximation – Discretize Space –Convert the environment into a grid. –Compute the Voronoi diagram on resulting grid by propagating wavefront from obstacles. –Remember which obstacle point the shortest path came from for each non−obstacle grid cell. –Can be slow to compute, depending on samples. A finer grid produces a more accurate answer but takes longer

GVD Approximation – Method 2 Approximation – Discretize Space (continued) –Create a grid from the environment

GVD Approximation – Method 2 Approximation – Discretize Space (continued) –Compute the Voronoi diagram by running a wavefront

GVD Approximation – Method 2 Approximation – Discretize Space (continued) –Compute a path in the Voronoi diagram

GVD Approximation – Method 2 Applet - Green path is discretized space path (i.e., grid). Red path is discretized obstacles path (i.e., previous). Green path is discretized space path (i.e., grid). Red path is discretized obstacles path (i.e., previous).

Hierarchical Approximations

The Medial Axis A related concept to GVD –Fills the interior of an object –Only defined for closed shapes –Instead equality of distance to two objects, it is where distance to self is equal

Another medial axis definition Real Example medial axis or skeleton is locus of centers of maximal circles that are bitangent to shape boundary

Skeleton classification Normal points End points Branch Points

Computing Medial Axis for Curves Start at end point –Local maximum in curvature Numerical methods to trace the bi-tangent circle Branch at tri- tangencies

Planning Using GVDs Is a GVD sufficient for path planning? –GVD computed in 2D workspace –Sufficient for a point robot –What about higher dimensions? Use GVD along with other methods

3-DOF Potential Field Planner with GVD Rigid robot moving on a plane in a dynamic environment [Hoff00] Combines a GVD roadmap with a local (potential field) planner

Voronoi Roadmap/Graph for Dynamic Environments Video (2d.avi)

Solving for GVD in Configuration Space Hierarchical testing of C-space Compute distance from C-space point to C-obs –Same as robot-obstacle distance Main problem –GVD is C-space dimension-1 –Projection into workspace doesn’t do what we hoped

Generalized Voronoi Graphs Build 1D graphs out of intersections of high-dimensional GVD parts –Not a connected roadmap

Hierarchical Generalized Voronoi Graphs Add in other structures based on 2 nd closest obstacles, etc.

Summary Voronoi Diagram –Roadmap –Clearance between obstacles –Higher dimensional problems are unsolved