1 motion planning (it’s all in the discretization) r&n: chap. 25 gives some background
Post on 20-Dec-2015
214 views
TRANSCRIPT
![Page 1: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/1.jpg)
1
Motion Planning(It’s all in the discretization)
R&N: Chap. 25 gives some background
![Page 2: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/2.jpg)
2
Motion planning is the ability for an agent to compute its own motions in order to achieve
certain goals. All autonomous robots and digital actors should eventually have this
ability
![Page 3: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/3.jpg)
3
Digital Actors
![Page 4: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/4.jpg)
4
Basic problem
Point robot in a 2-dimensional workspace with obstacles of known shape and position
Find a collision-free path between a start and a goal position of the robot
![Page 5: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/5.jpg)
5
Basic problem
Each robot position (x,y) can be seen as a state Continuous state space Then each state has an infinity of successors We need to discretize the state space
(x,y)
![Page 6: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/6.jpg)
6
Two Possible Discretizations
Grid-based Criticality-based
![Page 7: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/7.jpg)
7
Two Possible Discretizations
Grid-based Criticality-based
But this problem is very simple
How do these discretizations scale up?
![Page 8: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/8.jpg)
8
Intruder Finding Problem
A moving intruder is hiding in a 2-D workspace The robot must “sweep” the workspace to find
the intruder Both the robot and the intruder are points
robot’s visibilityregion
hidingregion 1
cleared region
2 3
4 5 6
robot
![Page 9: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/9.jpg)
9
Does a solution always exist?
![Page 10: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/10.jpg)
10
Does a solution always exist?
Easy to test: “Hole” in the workspace
Hard to test:No “hole” in the workspace
No !
![Page 11: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/11.jpg)
Information State
Example of an information state = (x,y,a=1,b=1,c=0)
An initial state is of the form (x,y,1, 1, ..., 1)
A goal state is any state of the form (x,y,0,0, ..., 0)
(x,y)
a = 0 or 1
c = 0 or 1
b = 0 or 1
0 cleared region1 hidding region
![Page 12: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/12.jpg)
12
Critical Line
a=0b=1
a=0b=1
Information state is unchanged
a=0b=0
Critical line
![Page 13: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/13.jpg)
13
A
B C D
E
Criticality-Based Discretization
Each of the regions A, B, C, D, and E consists of “equivalent” positions of the robot,so it’s sufficient to consider a single positionper region
![Page 14: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/14.jpg)
14
Criticality-Based Discretization
A
B C D
E
(C, 1, 1)
(D, 1)(B, 1)
![Page 15: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/15.jpg)
15
Criticality-Based Discretization
A
B C D
E
(C, 1, 1)
(D, 1)(B, 1)
(E, 1)(C, 1, 0)
![Page 16: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/16.jpg)
16
Criticality-Based Discretization
A
B C D
E
(C, 1, 1)
(D, 1)(B, 1)
(E, 1)(C, 1, 0)
(B, 0) (D, 1)
![Page 17: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/17.jpg)
17
Criticality-Based Discretization
A
C D
E
(C, 1, 1)
(D, 1)(B, 1)
(E, 1)(C, 1, 0)
(B, 0) (D, 1)Much smaller search tree than with grid-based discretization !
B
![Page 18: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/18.jpg)
18
Grid-Based Discretization
Ignores critical lines Visits many “equivalent” states Many information states per grid point Potentially very inefficient
![Page 19: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/19.jpg)
19
Example of Solution
![Page 20: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/20.jpg)
20
But ...
Criticality-based discretization does not scale well in practice when the dimensionality of the continuous space increases(It becomes prohibitively complex to define and compute)
![Page 21: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/21.jpg)
21
Motion Planning for an Articulated Robot
Find a path to a goal configuration that satisfies various constraints: collision avoidance, equilibrium, etc...
![Page 22: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/22.jpg)
22
Configuration Space of an Articulated Robot
A configuration of a robot is a list of non-redundant parameters that fully specify the position and orientation of each of its bodies
In this robot, one possible choice is: (q1, q2)
The configuration space (C-space) has 2 dimensions
![Page 23: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/23.jpg)
23
How many dimensions has the C-space of these 3
rings?
Answer:35 = 15
![Page 24: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/24.jpg)
Every robot maps to a point in its configuration space ...
q1
q3
q0
qn
q4
12 D
~65-120 D
6 D
15 D ~40 D
![Page 25: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/25.jpg)
... and every robot path is a curve in configuration space
q1
q3
q0
qn
q4
![Page 26: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/26.jpg)
But how do obstacles (and other constraints) map in configuration
space?
q1
q3
q0
qn
q4
12 D
~65-120 D
6 D
15 D ~40 D
![Page 27: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/27.jpg)
27
C-space “reduces” motion planning to
finding a path for a point
But how do the obstacle constraints map into C-space ?
![Page 28: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/28.jpg)
28
A Simple Example: Two-Joint Planar Robot Arm
Problems:• Geometric complexity• Space dimensionality
![Page 29: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/29.jpg)
29
Continuous state space
Discretization
Search
C-space
![Page 30: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/30.jpg)
30
About Discretization
Dimensionality + geometric complexity Criticality-based discretization turns out to be prohibitively complex
Dimensionality Grid-based discretization leads to
impractically large state spaces for dim(C-space) 6 Each grid node has 3n-1 neighbors, where n = dim(C-space)
![Page 31: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/31.jpg)
31
Robots with many joints: Modular Self-Reconfigurable
Robots
(M. Yim) (S. Redon)
Millipede-like robot with 13,000 joints
![Page 32: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/32.jpg)
32
Probabilistic Roadmap (PRM)feasible spacen-dimensional
C-spaceforbidden space
![Page 33: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/33.jpg)
33
Probabilistic Roadmap (PRM)
Configurations are sampled by picking coordinates at random
![Page 34: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/34.jpg)
34
Probabilistic Roadmap (PRM)
Configurations are sampled by picking coordinates at random
![Page 35: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/35.jpg)
35
Probabilistic Roadmap (PRM)
Sampled configurations are tested for collision (feasibility)
![Page 36: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/36.jpg)
36
Probabilistic Roadmap (PRM)
The collision-free configurations are retained as “milestones” (states)
![Page 37: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/37.jpg)
37
Probabilistic Roadmap (PRM)
Each milestone is linked by straight paths to its k-nearest neighbors
![Page 38: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/38.jpg)
38
Probabilistic Roadmap (PRM)
Each milestone is linked by straight paths to its k-nearest neighbors
![Page 39: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/39.jpg)
39
Probabilistic Roadmap (PRM)
The collision-free links are retained to form the PRM (state graph)
![Page 40: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/40.jpg)
40
Probabilistic Roadmap (PRM)
s
g
The start and goal configurations are connected to nodes of the PRM
![Page 41: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/41.jpg)
41
Probabilistic Roadmap (PRM)
The PRM is searched for a path from s to g
s
g
![Page 42: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/42.jpg)
42
Continuous state space
Discretization
Search A*
![Page 43: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/43.jpg)
43
Why Does PRM Work?
Because most feasible spaces verifies some good geometric (visibility) properties
![Page 44: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/44.jpg)
44
Why Does PRM Work?In most feasible spaces, every configuration “sees” a significant fraction of the feasible space
A relatively small number of milestones and connections between them are sufficient to cover most feasible spaces with high probability
![Page 45: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/45.jpg)
45
S1 S2
Narrow-Passage Issue
Lookout of S1
The lookout of a subset S of the feasible space is theset of all configurations in S from which it is possibleto “see” a significant fraction of the feasible space outside S
The feasible space is expansive if all of its subsets have a large lookout
![Page 46: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/46.jpg)
46
![Page 47: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/47.jpg)
47
In an expansive feasible space, the probability that a PRM planner with uniform sampling strategy finds a solution path, if one exists, goes to 1 exponentially with the number of milestones (~ running time)
A PRM planner can’t detect that no path exists. Like A*, it must be allocated a time limit beyond which it returns that no path exists. But this answer may be incorrect. Perhaps the planner needed more time to find one !
Probabilistic Completeness of a PRM Motion Planner
![Page 48: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/48.jpg)
48
Continuous state space
Discretization
Search
C-space
![Page 49: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/49.jpg)
49
Sampling Strategies
Issue: Where to sample configurations? That is, which probabilistic distribution to use?
Example: Two-stage sampling strategy:1. Construct initial PRM
with uniform sampling2. Identify milestones that
have few connections to their close neighbors
3. Sample more configurations around them
Greater density of milestones in “difficult” regions of the feasible space
![Page 50: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/50.jpg)
50
![Page 51: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/51.jpg)
51
Collision Checking Check whether objects overlap
![Page 52: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/52.jpg)
52
Hierarchical Collision Checking
Enclose objects into bounding volumes (spheres or boxes) Check the bounding volumes
![Page 53: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/53.jpg)
53
Hierarchical Collision Checking
Enclose objects into bounding volumes (spheres or boxes) Check the bounding volumes first Decompose an object into two
![Page 54: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/54.jpg)
54
Hierarchical Collision Checking
Enclose objects into bounding volumes (spheres or boxes) Check the bounding volumes first Decompose an object into two Proceed hierarchically
![Page 55: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/55.jpg)
55
Hierarchical Collision Checking
Enclose objects into bounding volumes (spheres or boxes) Check the bounding volumes first Decompose an object into two Proceed hierarchically
![Page 56: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/56.jpg)
56
Bounding Volume Hierarchy (BVH)
A BVH (~ balanced binary tree) is pre-computed for each object (obstacle, robot link)
![Page 57: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/57.jpg)
57
BVH of a 3D Triangulated Cat
![Page 58: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/58.jpg)
58
Collision Checking Between Two Objects
BVH of object 1
A
B C
A
B C
BVH of object 2
[Usually, the two trees have different sizes]
Search for a collision
![Page 59: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/59.jpg)
59
Search for a Collision
AA
Search tree
AA
pruning
![Page 60: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/60.jpg)
60
Search for a Collision
AA
Search tree
AA
Heuristic: Breakthe largest BV
![Page 61: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/61.jpg)
61
Search for a Collision
AA
CABA
Search tree
A
BC
Heuristic: Breakthe largest BV
![Page 62: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/62.jpg)
62
Search for a Collision
AA
CABA
Search tree
C
CCCB
BC
![Page 63: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/63.jpg)
63
Search for a Collision
AA
CABA
Search tree
C
CCCB
B
CB
If two leaves of the BVH’s overlap(here, C and B) check their contentfor collision
![Page 64: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/64.jpg)
64
Search Strategy If there is no collision, all paths must eventually be
followed down to pruning or a leaf node But if there is collision, one may try to detect it as
quickly as possible Greedy best-first search strategy with
f(N) = h(N) = d/(rX+rY)
[Expand the node XY with largest relative overlap (most likely to contain a collision)] rX
rYd
X
Y
![Page 65: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/65.jpg)
65
So, to discretize the state space of a motion planning problem, a PRM planner performs thousands of auxiliary searches (sometimes even more) to detect collisions !
But from an outsider’s point of view the search of the PRM looks like the main search
![Page 66: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/66.jpg)
66
Fortunately, hierarchical collision checkers are quite
fastOn average, over 10,000 collision checks per second for two 3-D objects each described by 500,000 triangles, on a contemporary PC
Checks are much faster when the objects are either neatly separated ( early pruning) or neatly overlapping ( quick detection of collision)
![Page 67: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/67.jpg)
67
![Page 68: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/68.jpg)
68
Free-Climbing Robot
LEMUR IIb robot (created by NASA/JPL)
![Page 69: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/69.jpg)
69
Only friction and internal degrees of freedom are used to achieve
equilibrium
![Page 70: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/70.jpg)
Lemur Capuchin
70
![Page 71: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/71.jpg)
71
1) One-step planning:Plan a path for moving a foot/hand from one hold to another
Can be solved using a PRM planner
2) Multi-step planning:Plan a sequence of one-step paths
Can be solved by searching a stance space
Two Levels of Planning
![Page 72: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/72.jpg)
72
Multi-Step Planning
initial 4-hold stance
3-hold stance
4-hold stance
...
... ...
...
![Page 73: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/73.jpg)
73
Multi-Step Planning
4 possible 3-hold stances
initial 4-hold stance
3-hold stance
4-hold stance
...
... ...
...
![Page 74: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/74.jpg)
74
Multi-Step Planning
Newcontact
initial 4-hold stance
3-hold stance
4-hold stance
...
... ...
...
several candidate 4-hold stances
![Page 75: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/75.jpg)
75
Multi-Step Planning
Newcontact
initial 4-hold stance
3-hold stance
4-hold stance
...
... ...
... ?
![Page 76: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/76.jpg)
76
Multi-Step Planning
breaking contact / zero force
initial 4-hold stance
3-hold stance
4-hold stance
...
... ...
...
![Page 77: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/77.jpg)
77
Multi-Step Planning
breaking contact / zero force
one-step planning
The one-step planner is needed to determine if a one-step path existsbetween two stances
initial 4-hold stance
3-hold stance
4-hold stance
...
... ...
...
![Page 78: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/78.jpg)
78
Multi-Step Planning
initial 4-hold stance
3-hold stance
4-hold stance
...
... ...
...New
contact
![Page 79: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/79.jpg)
79
Multi-Step Planning
one-step planning
initial 4-hold stance
3-hold stance
4-hold stance
...
... ...
...
![Page 80: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/80.jpg)
80
One-Step Planning
The contact constraints define specific C-space that is easy to sample at random
It is also easy to test (self-)collision avoidance and equilibrium constraints at sampled configurations
PRM planning
sg
![Page 81: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/81.jpg)
81
Hierarchical collision checking
Many searches !!
(+ searches for planning exploratory moves, forinterpreting 3D sensor data, ...)
Multi-step planner
One-step planner
![Page 82: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/82.jpg)
82
Several 10,000 queries Many infeasible Some critical
Multi-step planner
One-step planner
A PRM planner can’t detect that a query is infeasible How much time should it spend on each query? Too little, and it will often fail incorrectly Too much, and it will waste time on infeasible queries
Dilemma
![Page 83: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/83.jpg)
83
Dilemma
More than 1,000,000 stances, but only 20,000 feasible ones
Several 1000 one-step path queries A large fraction of them have no solution The running times for (feasible) queries
making up an 88-step path are highly variable
difficult queriesor bad luck?
![Page 84: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/84.jpg)
84
Possible Solution
Use learning method to train a “feasibility” classifier
Use this classifier to avoid infeasible one-step queries in the multi-step search tree
More on this later in a lecture on Learning (if there is enough time)
![Page 85: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/85.jpg)
85
Another Multi-Step Planning Problem:
Navigation of legged robots on rough terrain(stances foot placements)
![Page 86: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/86.jpg)
86
Another Multi-Step Planning Problem
Object manipulation (stances grasps)
[Yamane, Kuffner and Hodgins]
![Page 87: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/87.jpg)
87
Some Applications of Motion Planning
![Page 88: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/88.jpg)
88
Design for Manufacturing and Servicing
General MotorsGeneral Motors
General Electric
![Page 89: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/89.jpg)
89
Automatic Robot Programming
ABB
![Page 90: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/90.jpg)
90
Navigation through Virtual Environments
M. Lin, UNC
![Page 91: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/91.jpg)
91
Virtual Angiography
[S. Napel, 3D Medical Imaging Lab. Stanford]
![Page 92: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/92.jpg)
92
Radiosurgery
CyberKnife (Accuray)
![Page 93: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/93.jpg)
93
Transportation of A380 Fuselage through Small
Villages
Kineo
![Page 94: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/94.jpg)
94
Architectural Design: Verification of Building
Code
C. Han
![Page 95: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/95.jpg)
95
Architectural Design: Egress Analysis
![Page 96: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/96.jpg)
96
Planet Exploration
![Page 97: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/97.jpg)
97
[Yamane, Kuffner and Hodgins]
Autonomous Digital Actors
![Page 98: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/98.jpg)
98
Animation of Crowds
Amato
![Page 99: 1 Motion Planning (It’s all in the discretization) R&N: Chap. 25 gives some background](https://reader035.vdocument.in/reader035/viewer/2022062714/56649d415503460f94a1baf1/html5/thumbnails/99.jpg)
99