motion planning motion planning. 1.what is the motion planning problem? 2.what is the fundamental...
TRANSCRIPT
![Page 1: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/1.jpg)
Motion PlanningMotion Planning
![Page 2: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/2.jpg)
1. What is the motion planning problem?
2. What is the fundamental question in motion planning problem?
3. What is the basic problem formulation?
4. Configuration Space.
5. Formalism for Configuration Space.
6. What is a Path?
7. Extensions to the Basic Motion Planning Probem
8. Examples of Applications of Motion Planning
9. Examples of Practical Algorithms: Bug 2.
10.Examples : Probabilistic Roadmaps.
154 slides
![Page 3: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/3.jpg)
What is the What is the motion planning motion planning
problem?problem?
![Page 4: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/4.jpg)
![Page 5: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/5.jpg)
![Page 6: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/6.jpg)
Motion Planning for a robotic armMotion Planning for a robotic arm
![Page 7: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/7.jpg)
Motion Planning for a mobile robotMotion Planning for a mobile robot
![Page 8: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/8.jpg)
Motion planning in a real worldMotion planning in a real world
![Page 9: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/9.jpg)
Motion Planning for a Motion Planning for a Humanoid Robot with Humanoid Robot with Many Degrees of Many Degrees of Freedom in real world Freedom in real world environmentenvironment
![Page 10: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/10.jpg)
Motion Planning for unusual robots, reconfigurable robotsMotion Planning for unusual robots, reconfigurable robots
![Page 11: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/11.jpg)
Motion Planning in Medical and Motion Planning in Medical and Chemical ApplicationsChemical Applications
![Page 12: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/12.jpg)
Is It Easy?Is It Easy?
![Page 13: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/13.jpg)
What is the What is the fundamental fundamental question in question in
motion planning?motion planning?
![Page 14: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/14.jpg)
Goal of Motion PlanningGoal of Motion Planning
• Compute motion strategies, e.g.:– geometric paths – time-parameterized trajectories– sequence of sensor-based motion commands
• To achieve high-level goals, e.g.:– go to A without colliding with obstacles– assemble product P– build map of environment E– find object O
![Page 15: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/15.jpg)
Fundamental QuestionFundamental QuestionAre two given points connected by a path?
Valid region
Forbidden region
![Page 16: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/16.jpg)
Fundamental QuestionFundamental QuestionAre two given points connected by a path?
Valid region
Forbidden region
E.g.:▪Collision with obstacle▪Lack of visibility of an object▪Lack of stability
![Page 17: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/17.jpg)
What is the What is the formulation of the formulation of the basic problem of basic problem of
path finding path finding ??
![Page 18: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/18.jpg)
Basic Problem of Basic Problem of Path Path planningplanning
Statement: Compute a collision-free path for a rigid or articulated object (the robot) among static obstacles
Inputs:– Geometry of robot and obstacles– Kinematics of robot (degrees of freedom)– Initial and goal robot configurations (placements)
Output:– Continuous sequence of collision-free robot
configurations connecting the initial and goal configurations
![Page 19: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/19.jpg)
Examples with Rigid ObjectExamples with Rigid Object
Ladder problem
Piano-mover problem
![Page 20: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/20.jpg)
Example with Articulated Example with Articulated ObjectObject
![Page 21: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/21.jpg)
Configuration Configuration SpaceSpace
![Page 22: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/22.jpg)
Tool: Configuration SpaceTool: Configuration Space
![Page 23: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/23.jpg)
Compare!Compare!
Valid region
Forbidden region
![Page 24: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/24.jpg)
Tool: Configuration SpaceTool: Configuration Space
Problems:• Geometric complexity• Space dimensionality
![Page 25: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/25.jpg)
FormalismFormalism for for Configuration Configuration
SpaceSpace
![Page 26: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/26.jpg)
Notation for Configuration Notation for Configuration SpaceSpace
![Page 27: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/27.jpg)
Point Robot in Configuration space
![Page 28: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/28.jpg)
Point robot in Three-Dimensional Configuration space
![Page 29: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/29.jpg)
Translation and rotation of a robot
![Page 30: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/30.jpg)
Example of simple configuration space for a robot with 2DOF in planar space
![Page 31: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/31.jpg)
Representation of points in configuration space
![Page 32: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/32.jpg)
In presence of obstacles, where the robot can actually move?
![Page 33: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/33.jpg)
![Page 34: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/34.jpg)
![Page 35: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/35.jpg)
![Page 36: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/36.jpg)
![Page 37: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/37.jpg)
Free SpaceFree Space
![Page 38: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/38.jpg)
Think of R as a robot and P as an obstacle
![Page 39: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/39.jpg)
Robot that can translate and rotate in 2D space gives another dimension to the problem
![Page 40: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/40.jpg)
C-obstacle in Three-Dimensional C-obstacle in Three-Dimensional SpaceSpace
This is twisted
![Page 41: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/41.jpg)
Can we stay in 2D? x
![Page 42: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/42.jpg)
x
![Page 43: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/43.jpg)
But is it good?
![Page 44: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/44.jpg)
Too conservativeToo conservative
![Page 45: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/45.jpg)
What is a What is a Path?Path?
![Page 46: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/46.jpg)
What is a Path?What is a Path?
Path is a very general concept considered from the point of view of computational geometry, time and search
![Page 47: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/47.jpg)
Tool: Configuration SpaceTool: Configuration Space(C-Space C)(C-Space C)
![Page 48: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/48.jpg)
q=(q1,…,qn)
Configuration SpaceConfiguration Space
qq11
qq22
qq33
qqnn
In real problems configuration space is highly dimensional
![Page 49: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/49.jpg)
Definition of Robot Definition of Robot ConfigurationConfiguration
A robot configurationconfiguration is a specification of the positions of all robot points relative to a fixedfixed coordinate system
Usually a configuration is expressed as a “vector” “vector” of position/orientation parameters
![Page 50: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/50.jpg)
reference point
RigidRigid Robot Example Robot Example
• 3-parameter representation: q = (x,y,)• In a 3-D workspace q would be of the
form (x,y,z,)
x
y
robotreference direction
workspace
Like you need six-dimensional space to describe the airplane in the air
![Page 51: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/51.jpg)
ArticulatedArticulated Robot Robot ExampleExample
qq11
qq22
q = (q1,q2,…,q10)
![Page 52: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/52.jpg)
Protein exampleProtein example
![Page 53: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/53.jpg)
What is the What is the Configuration Space of Configuration Space of
a Robot?a Robot?Space of all its possible configurationsBut the topologytopology of this space is usually not that of a CartesianCartesian spaceC = S1 x S1
![Page 54: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/54.jpg)
Configuration Space of a Configuration Space of a RobotRobot
Space of all its possible configurationsBut the topology of this space is usually not that of a Cartesian space
C = S1 x S1
![Page 55: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/55.jpg)
Configuration Space of a Configuration Space of a RobotRobot
Space of all its possible configurationsBut the topology of this space is usually not that of a Cartesian space
C = S1 x S1
But here looks like a cartesian space
Like a torus
![Page 56: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/56.jpg)
What is a Topology of the What is a Topology of the Configuration Space?Configuration Space?
qq11
qq22
(S1)7xR3
R
R
R
S1
S1 is rotationR is linear motion
![Page 57: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/57.jpg)
Structure of Configuration Structure of Configuration SpaceSpace
Structure of Configuration Space is a manifoldFor each point q, there is a 1-to-1 map between a neighborhood of q and a Cartesian space Rn, where n is the dimension of C
This map is a local coordinate system called a chart.
C can always be covered by a finite number of charts. Such a set is called an atlas
![Page 58: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/58.jpg)
ExampleExampleEvery point of a sphere but one can be mapped to a plane
![Page 59: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/59.jpg)
reference point
Case of a Case of a PlanarPlanar RigidRigid RobotRobot
• 3-parameter representation: q = (x,y,) with [0,2). Two charts are needed
• Other representation: q = (x,y,cos,sin)c-space is a 3-D cylinder R2 x S1 embedded in a 4-D space
x
y
robotreference direction
workspace
![Page 60: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/60.jpg)
Rigid Robot in 3-D Rigid Robot in 3-D WorkspaceWorkspace
• q = (x,y,z,)
• Other representation: q = (x,y,z,r11,r12,…,r33) where r11, r12, …, r33 are the elements of rotation matrix R: r11 r12 r13
r21 r22 r23 r31 r32 r33
with: – ri1
2+ri22+ri3
2 = 1– ri1rj1 + ri2r2j + ri3rj3 = 0– det(R) = +1
The c-space is a 6-D space (manifold) embedded in a 12-D Cartesian space. It is denoted by R3xSO(3)
![Page 61: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/61.jpg)
MetricMetric in Configuration in Configuration SpaceSpace
A metric or distance function d in C is a mapmap
d: (q1,q2) C2 d(q1,q2) > 0such that:
– d(q1,q2) = 0 if and only if q1 = q2
– d(q1,q2) = d (q2,q1)
– d(q1,q2) < d(q1,q3) + d(q3,q2)
The general concept of metric or “distance” in some kind of space
![Page 62: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/62.jpg)
Metric in Configuration Metric in Configuration SpaceSpace
Example:• Robot A and point x of A
– x(q): location of x in the workspace when A is at configuration q
– A distance d in C is defined by:d(q,q’) = maxxA ||x(q)-x(q’)||
where ||a - b|| denotes the Euclidean distance between points a and b in the workspace
![Page 63: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/63.jpg)
Specific Examples in Specific Examples in RR22 x x SS11
q = (x,y,), q’ = (x’,y’,’) with ’ [0,2)= min{|’| , 2|’|}
d(q,q’) = sqrt[(x-x’)2 + (y-y’)2 + 2]d(q,q’) = sqrt[(x-x’)2 + (y-y’)2 + ()2]where is the maximal distance between the reference point and a robot point
’’
![Page 64: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/64.jpg)
What is a What is a PathPath??
A path in C is a piece of continuous curve connecting two configurations q and q’:
: s [0,1] (s) C s’ s d((s),(s’)) 0
q1
q3
q0
qn
q4
q2
(s)
![Page 65: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/65.jpg)
Other Possible Constraints on Other Possible Constraints on PathPath
Finite length, smoothness, curvature, etc… A trajectory is a path parameterized by
time: : t [0,T] (t) C
q1
q3
q0
qn
q4
q2
(s)
![Page 66: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/66.jpg)
Obstacles Obstacles in C-Spacein C-Space
![Page 67: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/67.jpg)
Obstacles in C-SpaceObstacles in C-Space
A configuration qq is collision-free, or free, if the robot placed at qq has null intersection null intersection with the obstacles in the workspace
The free space F is the set of free configurations
A C-obstacle is the set of configurations where the robot collides robot collides with a given workspace obstacle
A configuration is semi-free if the robot at this configuration touches obstacles without overlap without overlap
![Page 68: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/68.jpg)
DiscDisc Robot in 2-D Robot in 2-D WorkspaceWorkspace
Touches obstacle without overlap
BCB
![Page 69: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/69.jpg)
Rigid Robot Translating in Rigid Robot Translating in 2-D2-D
CB = B A = {b-a | aA, bB}
a1
b1
b1-a1
![Page 70: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/70.jpg)
Rigid Robot Rigid Robot Translating in Translating in 2-D2-D
CB = B A = {b-a | aA, bB}
a1
b1
b1-a1
![Page 71: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/71.jpg)
Linear-Time Computation Linear-Time Computation of of
C-Obstacle in 2-DC-Obstacle in 2-D(convex polygons)
O(n+m)
![Page 72: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/72.jpg)
Rigid Robot Rigid Robot TranslatingTranslating andand RotatingRotating in 2-D in 2-D
=/2
=0
Now configuration space has 3 dimensions
![Page 73: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/73.jpg)
C-Obstacle for C-Obstacle for ArticulatedArticulated RobotRobot
Two degrees of freedom
![Page 74: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/74.jpg)
Extensions to Extensions to Basic Motion Basic Motion
Planning Planning ProblemProblem
![Page 75: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/75.jpg)
Some Extensions of Basic Some Extensions of Basic ProblemProblem
1. Moving obstacles2. Multiple robots3. Movable objects4. Assembly planning5. Goal is to acquire
information by sensing1. Model building2. Object finding/tracking3. Inspection
6. Nonholonomic constraints
7. Dynamic constraints8. Stability constraints
1. Optimal planning2. Uncertainty in model,
control and sensing3. Exploiting task
mechanics (sensorless motions, under-actualted systems)
4. Physical models and deformable objects
5. Integration of planning and control
6. Integration with higher-level planning
![Page 76: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/76.jpg)
Aerospace Robotics Lab Aerospace Robotics Lab RobotRobot
air bearing
gas tank
air thrusters
obstacles
robot
![Page 77: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/77.jpg)
Total duration : 40 sec
Two concurrent planning goals:• Reach the goal• Reach a safe region
![Page 78: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/78.jpg)
Autonomous HelicopterAutonomous Helicopter
[Feron] (MIT)
![Page 79: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/79.jpg)
Assembly PlanningAssembly Planning
![Page 80: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/80.jpg)
Map BuildingMap Building
Where to move next?
![Page 81: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/81.jpg)
Target FindingTarget Finding
The guard guards the building attacked by terrorists. What he sees is colored yellow
![Page 82: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/82.jpg)
Target TrackingTarget Tracking
![Page 83: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/83.jpg)
Planning for Nonholonomic Planning for Nonholonomic RobotsRobots
![Page 84: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/84.jpg)
Under-Actuated SystemsUnder-Actuated Systems
video
[Lynch] (Northwestern)
![Page 85: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/85.jpg)
Planning with Uncertainty in Planning with Uncertainty in Sensing and ControlSensing and Control
I
GWW11
WW22
![Page 86: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/86.jpg)
Planning with Uncertainty in Planning with Uncertainty in Sensing and ControlSensing and Control
I
GWW11
WW22
![Page 87: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/87.jpg)
Planning with Uncertainty in Planning with Uncertainty in Sensing and ControlSensing and Control
I
GWW11
WW22
![Page 88: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/88.jpg)
Motion Planning for Motion Planning for Deformable ObjectsDeformable Objects
[Kavraki] (Rice)
![Page 89: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/89.jpg)
Examples of Examples of Applications of Applications of
Motion Motion PlanningPlanning
![Page 90: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/90.jpg)
Examples of ApplicationsExamples of Applications
1. Manufacturing:1. Robot programming2. Robot placement3. Design of part feeders
2. Design for manufacturing and servicing
3. Design of pipe layouts and cable harnesses
4. Autonomous mobile robots planetary exploration, surveillance, military scouting
1. Graphic animation of “digital actors” for video games, movies, and webpages
2. Virtual walkthru3. Medical surgery
planning4. Generation of
plausible molecule motions, e.g., docking and folding motions
5. Building code verification
![Page 91: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/91.jpg)
Robot ProgrammingRobot Programming
![Page 92: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/92.jpg)
Robot PlacementRobot Placement
![Page 93: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/93.jpg)
Design for Design for Manufacturing/ServicingManufacturing/Servicing
General ElectricGeneral Electric
General MotorsGeneral MotorsGeneral MotorsGeneral Motors
![Page 94: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/94.jpg)
Assembly Planning and Design Assembly Planning and Design of Manufacturing Systemsof Manufacturing Systems
![Page 95: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/95.jpg)
Part FeedingPart Feeding
![Page 96: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/96.jpg)
Part FeedingPart Feeding
![Page 97: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/97.jpg)
Cable Harness/ Pipe designCable Harness/ Pipe design
![Page 98: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/98.jpg)
Humanoid RobotHumanoid Robot
[Kuffner and Inoue, 2000] (U. Tokyo)
![Page 99: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/99.jpg)
Modular Reconfigurable Modular Reconfigurable RobotsRobots
Xerox, ParcXerox, Parc
Casal and Yim, 1999
![Page 100: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/100.jpg)
![Page 101: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/101.jpg)
Military Scouting and Military Scouting and Planet ExplorationPlanet Exploration
[CMU, NASA]
![Page 102: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/102.jpg)
Digital ActorsDigital Actors
A Bug’s Life (Pixar/Disney) Toy Story (Pixar/Disney)
Tomb Raider 3 (Eidos Interactive) Final Fantasy VIII (SquareOne)The Legend of Zelda (Nintendo)
Antz (Dreamworks)
![Page 103: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/103.jpg)
Motion Planning for Digital Motion Planning for Digital ActorsActors
Manipulation
Sensory-based locomotion
![Page 104: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/104.jpg)
Navigation Through Virtual Navigation Through Virtual EnvironmentsEnvironments
[Cheng-Chin U., UNC, Utrecht U.]
video
![Page 105: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/105.jpg)
Building Code VerificationBuilding Code Verification
![Page 106: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/106.jpg)
Radiosurgical PlanningRadiosurgical Planning
Cross-firing at a tumor while sparing healthy
critical tissue
![Page 107: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/107.jpg)
Study of Study of the Motion of Bio-Moleculesthe Motion of Bio-Molecules
• Protein folding• Ligand binding
![Page 108: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/108.jpg)
Practical Applications in Practical Applications in ProjectsProjects
Present a coherent framework for motion planning problems
Emphasis of “practical” algorithms with some guarantees of performance over “theoretical” or purely “heuristic” algorithms
![Page 109: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/109.jpg)
FrameworkFramework
Continuous representation(configuration space and related spaces + constraints)
Discretization(random sampling, criticality-based decomposition)
Graph searching(blind, best-first, A*)
![Page 110: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/110.jpg)
Practical Algorithms (1/2)Practical Algorithms (1/2)
A complete motion planner always returns a solution plan when one exists and indicates that no such plan exists otherwise.
Most motion planning problems are hard, meaning that complete planners take exponential time in # of degrees of freedom, objects, etc.
![Page 111: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/111.jpg)
Practical Algorithms (2/2)Practical Algorithms (2/2)
Theoretical algorithms strive for completeness and minimal worst-case complexity. Difficult to implement and not robust.Heuristic algorithms strive for efficiency in commonly encountered situations. Usually no performance guarantee. Weaker completeness Simplifying assumptions Exponential algorithms that work in practice
![Page 112: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/112.jpg)
Programming ProjectProgramming Project• Navigate in virtual environment
• Simulate legged robot
• Inspection of structures
• Search and escape
![Page 113: Motion Planning Motion Planning. 1.What is the motion planning problem? 2.What is the fundamental question in motion planning problem? 3.What is the basic](https://reader033.vdocuments.us/reader033/viewer/2022052510/56649e455503460f94b3abc2/html5/thumbnails/113.jpg)
SourcesSources
Davi GeigerDavi Geiger
Jean-Claude LatombeJean-Claude Latombe