1. CS 326 A: Motion Planning http://robotics.stanford.edu/~latombe/cs326/2002 Instructor: Jean-Claude Latombe Teaching Assistant: Itay Lotan Computer Science Department Stanford University

2. Goal 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

3. Fundamental Question Are two given points connected by a path?

4. Basic Problem 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

5. Examples with Rigid Object  Ladder problem Piano-mover problem 

6. Is It Easy?

7. Example with Articulated Object

9. Tool: Configuration Space Problems: Geometric complexity Space dimensionality

10. Some Extensions of Basic Problem Moving obstacles Multiple robots Movable objects Assembly planning Goal is to acquire information by sensing –Model building –Object finding/tracking Nonholonomic constraints Dynamic constraints Optimal planning Uncertainty in control and sensing Exploiting task mechanics (sensorless motions) Physical models and deformable objects Integration of planning and control

11. Aerospace Robotics Lab Robot air bearing gas tank air thrusters obstacles robot

12. Total duration : 40 sec Two concurrent planning goals: Reach the goal Reach a safe region

13. Autonomous Helicopter [Feron, 2000] (AA Dept., MIT)

14. Some Extensions of Basic Problem Moving obstacles Multiple robots Movable objects Assembly planning Goal is to acquire information by sensing –Model building –Object finding/tracking Nonholonomic constraints Dynamic constraints Optimal planning Uncertainty in control and sensing Exploiting task mechanics (sensorless motions) Physical models and deformable objects Integration of planning and control

15. Dynamic Unpredictable Environment

16. Some Extensions of Basic Problem Moving obstacles Multiple robots Movable objects Assembly planning Goal is to acquire information by sensing –Model building –Object finding/tracking Nonholonomic constraints Dynamic constraints Optimal planning Uncertainty in control and sensing Exploiting task mechanics (sensorless motions) Physical models and deformable objects Integration of planning and control

17. Assembly Planning

18. Some Extensions of Basic Problem Moving obstacles Multiple robots Movable objects Assembly planning Goal is to acquire information by sensing –Model building –Object finding/tracking Nonholonomic constraints Dynamic constraints Optimal planning Uncertainty in control and sensing Exploiting task mechanics (sensorless motions) Physical models and deformable objects Integration of planning and control

19. Map Building Where to move next?

20. Target Finding

21. Target Tracking

22. Some Extensions of Basic Problem Moving obstacles Multiple robots Movable objects Assembly planning Goal is to acquire information by sensing –Model building –Object finding/tracking Nonholonomic constraints Dynamic constraints Optimal planning Uncertainty in control and sensing Exploiting task mechanics (sensorless motions) Physical models and deformable objects Integration of planning and control

23. Planning for Nonholonomic Robots

24. Some Extensions of Basic Problem Moving obstacles Multiple robots Movable objects Assembly planning Goal is to acquire information by sensing –Model building –Object finding/tracking Nonholonomic constraints Dynamic constraints Optimal planning Uncertainty in control and sensing Exploiting task mechanics (sensorless motions) Physical models and deformable objects Integration of planning and control

25. Planning with Uncertainty in Sensing and Control I G W1W1W1W1 W2W2W2W2

26. Some Extensions of Basic Problem Moving obstacles Multiple robots Movable objects Assembly planning Goal is to acquire information by sensing –Model building –Object finding/tracking Nonholonomic constraints Dynamic constraints Optimal planning Uncertainty in control and sensing Exploiting task mechanics (sensorless motions) Physical models and deformable objects Integration of planning and control

27. Motion Planning for Deformable Objects [Kavraki, 1999]

28. Examples of Applications Manufacturing: –Robot programming –Robot placement –Design of part feeders Design for manufacturing and servicing Design of pipe layouts and cable harnesses Autonomous mobile robots planetary exploration, surveillance, military scouting Graphic animation of “digital actors” for video games, movies, and webpages Medical surgery planning Generation of plausible molecule motions, e.g., docking and folding motions Building code verification

29. Robot Programming

30. Robot Placement

31. Humanoid Robot [Kuffner and Inoue, 2000] (U. Tokyo)

32. Modular Reconfigurable Robots Xerox, Parc Casal and Yim, 1999

33. Video

34. Examples of Applications Manufacturing: –Robot programming –Robot placement –Design of part feeders Design for manufacturing and servicing Design of pipe layouts and cable harnesses Autonomous mobile robots planetary exploration, surveillance, military scouting Graphic animation of “digital actors” for video games, movies, and webpages Medical surgery planning Generation of plausible molecule motions, e.g., docking and folding motions Building code verification

35. Design for Manufacturing/Servicing General Electric General Motors

36. Assembly Planning and Design of Manufacturing Systems

37. Examples of Applications Manufacturing: –Robot programming –Robot placement –Design of part feeders Design for manufacturing and servicing Design of pipe layouts and cable harnesses Autonomous mobile robots planetary exploration, surveillance, military scouting Graphic animation of “digital actors” for video games, movies, and webpages Medical surgery planning Generation of plausible molecule motions, e.g., docking and folding motions Building code verification

38. Military Scouting and Planet Exploration

39. Examples of Applications Manufacturing: –Robot programming –Robot placement –Design of part feeders Design for manufacturing and servicing Design of pipe layouts and cable harnesses Autonomous mobile robots planetary exploration, surveillance, military scouting Graphic animation of “digital actors” for video games, movies, and webpages Medical surgery planning Generation of plausible molecule motions, e.g., docking and folding motions Building code verification

40. Digital 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)

41. Motion Planning for Digital Actors Manipulation Sensory-based locomotion

42. Examples of Applications Manufacturing: –Robot programming –Robot placement –Design of part feeders Design for manufacturing and servicing Design of pipe layouts and cable harnesses Autonomous mobile robots planetary exploration, surveillance, military scouting Graphic animation of “digital actors” for video games, movies, and webpages Medical surgery planning Generation of plausible molecule motions, e.g., docking and folding motions Building code verification

43. Radiosurgical Planning Cross-firing at a tumor while sparing healthy critical tissue

44. Examples of Applications Manufacturing: –Robot programming –Robot placement –Design of part feeders Design for manufacturing and servicing Design of pipe layouts and cable harnesses Autonomous mobile robots planetary exploration, surveillance, military scouting Graphic animation of “digital actors” for video games, movies, and webpages Medical surgery planning Generation of plausible molecule motions, e.g., docking and folding motions Building code verification

45. Study of the Motion of Bio-Molecules Protein folding Ligand binding

46. Study of the Motion of Bio-Molecules Protein folding Ligand binding

47. Examples of Applications Manufacturing: –Robot programming –Robot placement –Design of part feeders Design for manufacturing and servicing Design of pipe layouts and cable harnesses Autonomous mobile robots planetary exploration, surveillance, military scouting Graphic animation of “digital actors” for video games, movies, and webpages Medical surgery planning Generation of plausible molecule motions, e.g., docking and folding motions Building code verification

48. Building Code Verification

49. Goals of CS326A  Present a coherent framework for motion planning problems: –configuration space and related spaces –random sampling and criticality-based decomposition algorithms  Emphasis of “practical” algorithms with some guarantees of performance over “theoretical” or purely “heuristic” algorithms

50. Framework Continuous representation (configuration space formulation) Discretization (random sampling, criticality-based decomposition) Graph searching (blind, best-first, A*)

51. Goals of CS326A  Present a coherent framework for motion planning problems: –configuration space and related spaces –random sampling and criticality-based decomposition algorithms  Emphasis of “practical” algorithms with some guarantees of performance over “theoretical” or purely “heuristic” algorithms

52. 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.

53. 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

54. Prerequisites for CS326A Ability and willingness to complete a significant programming project with simple graphic interface. Basic knowledge and taste for geometry and algorithms. Interest in devoting reasonable time each week in reading four papers.

55. CS326A is not a course in … Differential Geometry and Topology Kinematics and Dynamics Basic Algorithms Geometrics Modeling … but it makes use of knowledge from all these areas

56. Work to Do A.Attend every class B.Prepare/give two presentations with ppt slides (30 min each) C.For each class read the two papers listed as “required reading” in advance D.Complete the programming project E.Complete two homework assignments

57. Website / Class Schedule robotics.stanford.edu/~latombe/cs326/2002

58. Programming Project Topic: Implement a Probabilistic Roadmap planner Assumptions: –The robot operates in a 2D workspace –It consists of one or several polygonal bodies moving independently or connected by joints (your software should allow various kinds of kinematics) –Obstacles are static polygons Goal: –Implement, test, and compare several algorithms for selecting samples (milestones), generating connections between them, and checking collision