Motion Planning
description
Transcript of Motion Planning
![Page 1: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/1.jpg)
Motion Planning
Majd Srour
![Page 2: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/2.jpg)
Definition Motion planning refers to the
computational process of moving from one place to another in the presence of obstacles.
![Page 3: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/3.jpg)
Work space The physical space in which the
robot of finite-size. – Real world
![Page 4: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/4.jpg)
Configuration Space (Only translation) The configuration space is a
transformation from the physical space in which the robot is of finite-size into another space in which the robot is treated as a point.
The configuration space is obtained by shrinking the robot to a point, while growing the obstacles by the size of the robot.
![Page 5: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/5.jpg)
Work space vs Configuration space
![Page 6: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/6.jpg)
Free Space The free space of a configuration
space simply consists of the areas not occupied by obstacles. Any configuration within this space is called a free configuration.
![Page 7: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/7.jpg)
Free Path The free path between an initial
configuration and a goal configuration is the path which lies completely in free space and does not come into contact with any obstacles.
![Page 8: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/8.jpg)
Motion Planning Problems (from easy to hard) :
Completely known static Obstacles Completely known dynamic
Obstacles Partially Known static Obstacles Partially Known dynamic Obstacles
![Page 9: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/9.jpg)
Roadmap Approach Visibility Graph
Voronoi method
Cell Decomposition
![Page 10: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/10.jpg)
Visibility Graph A visibility graph is a graph of
intervisible locations, typically for a set of points and obstacles in the Euclidean plane
![Page 11: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/11.jpg)
Visibility Graph Given a set S of disjoint (open)
polygons..
![Page 12: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/12.jpg)
Visibility Graph Let V(S) be the vertex of S
![Page 13: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/13.jpg)
Visibility Graph Let V(S) be the vertex of S
Let be the visibility graph of S.
( ) ( ( ), )vis visG S V S E
![Page 14: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/14.jpg)
Visibility Graph Let V(S) be the vertex of S
Let be the visibility graph of S.
Where:
( ) ( ( ), )vis visG S V S E
{ ( ), }| ,visE uv u v V S u sees v
![Page 15: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/15.jpg)
Visibility Graph Let V(S) be the vertex of S
Let be the visibility graph of S.
Where:
( ) ( ( ), )vis visG S V S E
{ ( ), }| ,visE uv u v V S u sees v
![Page 16: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/16.jpg)
Visibility Graph Let V(S) be the vertex of S
Let be the visibility graph of S.
Where:
( ) ( ( ), )vis visG S V S E
{ ( ), }| ,visE uv u v V S u sees v
freeuv Cu sees v
![Page 17: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/17.jpg)
Visibility Graph Let V(S) be the vertex of S
Let be the visibility graph of S.
Where:
( ) ( ( ), )vis visG S V S E
{ ( ), }| ,visE uv u v V S u sees v
2( )|freeuv C Su sees v R
![Page 18: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/18.jpg)
Visibility Graph Let V(S) be the vertex of S
Let be the visibility graph of S.
Where:
( ) ( ( ), )vis visG S V S E
{ ( ), }| ,visE uv u v V S u sees v
2( )|freeuv C Su sees v R
![Page 19: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/19.jpg)
Visibility Graph Let V(S) be the vertex of S
Let be the visibility graph of S.
Where:
( ) ( ( ), )vis visG S V S E
{ ( ), }| ,visE uv u v V S u sees v
2( )|freeuv C Su sees v R
![Page 20: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/20.jpg)
Visibility Graph Let V(S) be the vertex of S
Let be the visibility graph of S.
Where:
( ) ( ( ), )vis visG S V S E
{ ( ), }| ,visE uv u v V S u sees v
2( )|freeuv C Su sees v R
startPgoalP
![Page 21: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/21.jpg)
Visibility Graph Let V(S) be the vertex of S
Let be the visibility graph of S.
Where:
( ) ( ( ), )vis visG S V S E
{ ( ), }| ,visE uv u v V S u sees v
( ) ) , }{( start goalV S V S PP
startPgoalP
![Page 22: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/22.jpg)
Visibility Graph Let V(S) be the vertex of S
Let be the visibility graph of S.
Where:
( ) ( ( ), )vis visG S V S E
{ ( ), }| ,visE uv u v V S u sees v
( ) ) , }{( start goalV S V S PP
startPgoalP
![Page 23: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/23.jpg)
Visibility Graph Let V(S) be the vertex of S
Let be the visibility graph of S.
Where:
( ) ( ( ), )vis visG S V S E
{ ( ), }| ,visE uv u v V S u sees v
( ) ) , }{( start goalV S V S PP
startPgoalP
![Page 24: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/24.jpg)
Visibility Graph Corollary: The shortest path
between P_start and P_goal corresponds to a shortest path in ( ) ( ( ), )vis visG S V S E
startPgoalP
![Page 25: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/25.jpg)
Finding the shortest path We’ll use Dijkstra algorithm in
order to find the shortest path in G For each return
.( ) ( , )vis Eucuv do w uv d u vE
( , , ),vis start goalDIJKSTRA G w PP
![Page 26: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/26.jpg)
Dijkstra Assign to every node a distance value of infinity, and to
the first node 0 Mark all nodes as unvisited, set initial node as current For current node, consider all of its unvisited neighbors
and calculate their tentative distances When we are done considering all of the neighbors of
the current node, mark the current node as visited and remove it from the unvisited set. A visited node will never be checked again; its distance recorded now is final and minimal.
If the destination node has been marked visited then stop.
Set the unvisited node marked with the smallest tentative distance as the next "current node" and go back to step 3.
![Page 27: Motion Planning](https://reader036.fdocuments.net/reader036/viewer/2022062520/56816119550346895dd07210/html5/thumbnails/27.jpg)
Example Find shortest path from a to z http://www.youtube.com/watch?
v=UG7VmPWkJmA