Roadmap Methods How do I get there? Visibility Graph Voronoid Diagram.

Slides:



Advertisements
Similar presentations
1 Motion and Manipulation Configuration Space. Outline Motion Planning Configuration Space and Free Space Free Space Structure and Complexity.
Advertisements

Configuration Space. Recap Represent environments as graphs –Paths are connected vertices –Make assumption that robot is a point Need to be able to use.
Map Overlay Algorithm. Birch forest Wolves Map 1: Vegetation Map 2: Animals.
Fall Path Planning from text. Fall Outline Point Robot Translational Robot Rotational Robot.
Approximations of points and polygonal chains
Motion Planning for Point Robots CS 659 Kris Hauser.
Visibility Graph Team 10 NakWon Lee, Dongwoo Kim.
Manipulation Planning. In 1995 Alami, Laumond and T. Simeon proposed to solve the problem by building and searching a ‘manipulation graph’.
Visibility Graphs May Shmuel Wimer Bar-Ilan Univ., Eng. Faculty Technion, EE Faculty.
Visibility Graph and Voronoi Diagram CS Tutorial.
5. Roadmaps Hyeokjae Kwon Sungmin Kim. 1. RoadMap Definition.
Visibility Computations: Finding the Shortest Route for Motion Planning COMP Presentation Eric D. Baker Tuesday 1 December 1998.
1 Last lecture  Configuration Space Free-Space and C-Space Obstacles Minkowski Sums.
Motion Planning. Basic Topology Definitions  Open set / closed set  Boundary point / interior point / closure  Continuous function  Parametric curve.
Configuration Space CS 326 A: Motion Planning
1 Last lecture  Path planning for a moving Visibility graph Cell decomposition Potential field  Geometric preliminaries Implementing geometric primitives.
Algorithmic Robotics and Motion Planning Dan Halperin Tel Aviv University Fall 2006/7 Algorithmic motion planning, an overview.
CS 326A: Motion Planning Configuration Space. Motion Planning Framework Continuous representation (configuration space and related spaces + constraints)
1 Target Finding. 2 Example robot’s visibility region hiding region 1 cleared region robot.
UMass Lowell Computer Science Advanced Algorithms Computational Geometry Prof. Karen Daniels Spring, 2010 O’Rourke Chapter 8 Motion Planning.
CS 326A: Motion Planning Criticality-Based Motion Planning: Target Finding.
Navigation and Motion Planning for Robots Speaker: Praveen Guddeti CSE 976, April 24, 2002.
Roadmap Methods How do I get there? Visibility Graph Voronoid Diagram.
CS 326 A: Motion Planning robotics.stanford.edu/~latombe/cs326/2003/index.htm Configuration Space – Basic Path-Planning Methods.
Math 310 Sections Isometry. Transformations Def A transformation is a map from the plane to itself that takes each point in the plane to exactly.
Robot Motion Planning Bug 2 Probabilistic Roadmaps Bug 2 Probabilistic Roadmaps.
UMass Lowell Computer Science Advanced Algorithms Computational Geometry Prof. Karen Daniels Spring, 2004 O’Rourke Chapter 8 Motion Planning.
CS 326A: Motion Planning Basic Motion Planning for a Point Robot.
Spring 2007 Motion Planning in Virtual Environments Dan Halperin Yesha Sivan TA: Alon Shalita Basics of Motion Planning (D.H.)
Introduction to Robot Motion Planning. Example A robot arm is to build an assembly from a set of parts. Tasks for the robot: Grasping: position gripper.
1 Single Robot Motion Planning Liang-Jun Zhang COMP Sep 22, 2008.
UMass Lowell Computer Science Advanced Algorithms Computational Geometry Prof. Karen Daniels Spring, 2007 O’Rourke Chapter 8 Motion Planning.
UNC Chapel Hill M. C. Lin Point Location Chapter 6 of the Textbook –Review –Algorithm Analysis –Dealing with Degeneracies.
Graphs and Sets Dr. Andrew Wallace PhD BEng(hons) EurIng
CSE53111 Computational Geometry TOPICS q Preliminaries q Point in a Polygon q Polygon Construction q Convex Hulls Further Reading.
Visibility Graphs and Cell Decomposition By David Johnson.
Graph Theory Ch6 Planar Graphs. Basic Definitions  curve, polygon curve, drawing  crossing, planar, planar embedding, and plane graph  open set  region,
4/21/15CMPS 3130/6130 Computational Geometry1 CMPS 3130/6130 Computational Geometry Spring 2015 Motion Planning Carola Wenk.
UNC Chapel Hill M. C. Lin Point Location Reading: Chapter 6 of the Textbook Driving Applications –Knowing Where You Are in GIS Related Applications –Triangulation.
May Motion Planning Shmuel Wimer Bar Ilan Univ., Eng. Faculty Technion, EE Faculty.
© Manfred Huber Autonomous Robots Robot Path Planning.
B659: Principles of Intelligent Robot Motion Kris Hauser.
Computational Geometry Piyush Kumar (Lecture 10: Robot Motion Planning) Welcome to CIS5930.
Path Planning for a Point Robot
Introduction to Robot Motion Planning Robotics meet Computer Science.
CS B659: Principles of Intelligent Robot Motion Configuration Space.
October 9, 2003Lecture 11: Motion Planning Motion Planning Piotr Indyk.
UNC Chapel Hill M. C. Lin Introduction to Motion Planning Applications Overview of the Problem Basics – Planning for Point Robot –Visibility Graphs –Roadmap.
Topics Paths and Circuits (11.2) A B C D E F G.
12.1 Exploring Solids.
Robotics Chapter 5 – Path and Trajectory Planning
Convex Sets & Concave Sets A planar region R is called convex if and only if for any pair of points p, q in R, the line segment pq lies completely in R.
Motion Planning Howie CHoset. Assign HW Algorithms –Start-Goal Methods –Map-Based Approaches –Cellular Decompositions.
February 17, 2005Lecture 6: Point Location Point Location (most slides by Sergi Elizalde and David Pritchard)
1 Schematization of Networks Rida Sadek. 2 This talk discusses: An algorithm that is studied in the following papers:  S. Cabello, M. de Berg, and M.
Robot Motion Planning Robotics meet Computer Science.
4/9/13CMPS 3120 Computational Geometry1 CMPS 3120: Computational Geometry Spring 2013 Motion Planning Carola Wenk.
NUS CS 5247 David Hsu Configuration Space. 2 What is a path?
UNC Chapel Hill M. C. Lin Geometric Data Structures Reading: Chapter 10 of the Textbook Driving Applications –Windowing Queries Related Application –Query.
2.1 Introduction to Configuration Space
How do I get there? Roadmap Methods Visibility Graph Voronoid Diagram.
Example robot cleared region robot’s visibility region hiding region 2
Graphs, Trees and Algorithms 1
Chapter 7 Voronoi Diagrams
HW2 EE 562.
Planarity.
Configuration Space of an Articulated Robot
Computational Geometry
Robotics meet Computer Science
Planning.
Presentation transcript:

Roadmap Methods How do I get there? Visibility Graph Voronoid Diagram

The Roadmap Idea Capture the connectivity of C free in a network of 1-D curves: the roadmap

Visibility Graph Method (VGM) Polygonal robot A translating at fix orientation No rotation! Polygonal obstacle in R 2 VGM: construct a semi-free path as a simple polygonal line connecting q init to q goal

Main Proposition CB a polygonal region of the plane There exists a semi-free path between q init and q goal   There exists a simple polygonal line lying in cl(C free ) with end points q init and q goal and such that its vertices are certices of CB

Example q init q goal

Visibility Graph - Definition The visibility graph is the non-directed graph G specified as: Nodes: q init, q goal and vertices of CB Edges: 2 nodes connected if either the line segment joining them is an edge of CB, or it lies entirely in C free at endpoints Algorithm of the visibility graph method: 1.Construct visibility graph G 2.Search G for a path from q init to q goal 3.If a path is found, return it; otherwise failure

Constructing the VG: Naïve Approach X, X’: q init, q goal or CB vertices If X, X’ endpoints of same edge of CB, then the nodes are connected by a link Otherwise X, X’ are connected by a link iff the line passing through them does not intersect CB Complexity of algorithm O(n 3 )

Variation of sweep-line algorithm For each X, compute the orientation  i of every half-line from X to another point X i. Sort these orientations. Rotate half-line from X, from 0 to 2 . Stop at each  i. At each stop, update intersection with CB Algorithm is O(n 2 logn) Constructing the VG: Improvement

Retraction Approach Def.: X a topological space, Y a subspace of X. A surjective map X  Y is a retraction iff it is continuous and its restriction to Y is the identity Def.: the retraction  preserves connectivity iff for all x  X, x and  (x) are in the same path- connected component. Proposition: Let  :C free  R, where R  C free is a network of 1D curves, be a CPR. There exists a free-path between q init and q goal iff there exists a path in R between  (q init) and  (q goal )

Voronoid Diagram Def.: let  =  C free. For any q in C free, let Clearance(q)=min p   ||q-p|| Near(q)={p   / ||q-p||=clearance(q)} The Voronoid diagram of C free is the set: Vor(C free )={q  C free / card(near(q))>1}