B659: Principles of Intelligent Robot Motion

1. B659: Principles of Intelligent Robot Motion Kris Hauser

2. Agenda • Skimming through Principles Ch. 2, 5.1, 6.1

3. Fundamental question of motion planning • Are the two given points connected by a path? Feasible space Forbidden region

4. Tool: Configuration Space

5. s Problem free space obstacle free path obstacle g obstacle

6. s Problem Semi-free path obstacle obstacle g obstacle

7. Local constraints: lie in free space Differential constraints: have bounded curvature Global constraints: have minimal length Types of Path Constraints

8. Homotopy of Free Paths

9. Motion-Planning Framework Continuous representation Discretization Graph searching (blind, best-first, A*)

10. Path-Planning Approaches RoadmapRepresent the connectivity of the free space by a network of 1-D curves Cell decompositionDecompose the free space into simple cells and represent the connectivity of the free space by the adjacency graph of these cells Potential fieldDefine a function over the free space that has a global minimum at the goal configuration and follow its steepest descent

11. Roadmap Methods Visibility graphIntroduced in the Shakey project at SRI in the late 60s. Can produce shortest paths in 2-D configuration spaces

12. Simple (Naïve) Algorithm Install all obstacles vertices in VG, plus the start and goal positions For every pair of nodes u, v in VG If segment(u,v) is an obstacle edge then insert (u,v) into VG else for every obstacle edge e if segment(u,v) intersects e then goto 2 insert (u,v) into VG Search VG using A*

13. Complexity Simple algorithm: O(n3) time Rotational sweep: O(n2 log n) Optimal algorithm: O(n2) Space: O(n2)

14. Rotational Sweep

15. Rotational Sweep

16. Rotational Sweep

17. Rotational Sweep

18. Rotational Sweep

19. Reduced Visibility Graph can’t be shortest path tangent segments  Eliminate concave obstacle vertices

20. Generalized (Reduced) Visibility Graph tangency point

21. Three-Dimensional Space Shortest path passes through none of the vertices locally shortest path homotopic to globally shortest path Computing the shortest collision-free path in a polyhedral space is NP-hard

22. Roadmap Methods Voronoi diagramIntroduced by Computational Geometry researchers. Generate paths that maximizes clearance. O(n log n) timeO(n) space

23. Roadmap Methods Visibility graph Voronoi diagram SilhouetteFirstcomplete general method that applies to spaces of any dimension and is singly exponential in # of dimensions [Canny, 87] Probabilistic roadmaps

24. Cell-Decomposition Methods Two classes of methods: Exact cell decompositionThe free space F is represented by a collection of non-overlapping cells whose union is exactly FExample: trapezoidal decomposition

25. Path-Planning Approaches RoadmapRepresent the connectivity of the free space by a network of 1-D curves Cell decompositionDecompose the free space into simple cells and represent the connectivity of the free space by the adjacency graph of these cells Potential fieldDefine a function over the free space that has a global minimum at the goal configuration and follow its steepest descent

26. Trapezoidal decomposition

27. Trapezoidal decomposition

28. Trapezoidal decomposition

29. Trapezoidal decomposition

30. … critical events  criticality-based decomposition Trapezoidal decomposition

31. Trapezoidal decomposition Planar sweep  O(n log n) time, O(n) space

32. Cell-Decomposition Methods Two classes of methods: Exact cell decomposition Approximate cell decompositionF is represented by a collection of non-overlapping cells whose union is contained in FExamples: quadtree, octree, 2n-tree

33. Octree Decomposition

34. Sketch of Algorithm Compute cell decomposition down to some resolution Identify start and goal cells Search for sequence of empty/mixed cells between start and goal cells If no sequence, then exit with no path If sequence of empty cells, then exit with solution If resolution threshold achieved, then exit with failure Decompose further the mixed cells Return to 2

35. Path-Planning Approaches RoadmapRepresent the connectivity of the free space by a network of 1-D curves Cell decompositionDecompose the free space into simple cells and represent the connectivity of the free space by the adjacency graph of these cells Potential fieldDefine a function over the free space that has a global minimum at the goal configuration and follow its steepest descent

36. Approach initially proposed for real-time collision avoidance [Khatib, 86]. Hundreds of papers published on it. Potential Field Methods Goal Robot

37. Attractive and Repulsive fields

38. Local-Minimum Issue • Perform best-first search (possibility of combining with approximate cell decomposition) • Alternate descents and random walks • Use local-minimum-free potential (navigation function)

39. Sketch of Algorithm (with best-first search) Place regular grid G over space Search G using best-first search algorithm with potential as heuristic function

40. Simple Navigation Function 2 1 2 3 1 1 2 2 3 3 4 4 0 5

41. Simple Navigation Function 2 1 2 3 1 0 1 2 2 3 3 4 5 4

42. Simple Navigation Function 2 1 2 3 1 0 1 2 2 3 3 4 5 4

43. Completeness of Planner A motion planner is complete if it finds a collision-free path whenever one exists and return failure otherwise. Visibility graph, Voronoi diagram, exact cell decomposition, navigation function provide complete planners Weaker notions of completeness, e.g.:- resolution completeness (PF with best-first search)- probabilistic completeness (PF with random walks)

44. A probabilistically complete planner returns a path with high probability if a path exists. It may not terminate if no path exists. A resolution complete planner discretizes the space and returns a path whenever one exists in this representation.

45. Preprocessing / Query Processing Preprocessing:Compute visibility graph, Voronoi diagram, cell decomposition, navigation function Query processing:- Connect start/goal configurations to visibility graph, Voronoi diagram- Identify start/goal cell- Search graph

46. Issues for Future Lectures on Planning Space dimensionality Geometric complexity of the free space Constraints other than avoiding collision The goal is not just a position to reach Etc …

47. Semester Project • Topic of your choosing, advised and approved by instructor • Groups of 1-3 students • Schedule • Proposal (Feb.) • Mid term report / discussion (March) • Final presentation (end of April)

48. Semester Project Discussion • Three types of project: • Make a robot or virtual character perform a task • Implement and analyze an algorithm (empirically or mathematically) • Analyze natural motion using principles from robotics

49. Project Ideas • Robot chess • Finding and tracking people indoors • UI for assistive robot arms • Analysis for psychological observation studies (Prof. Yu) • Outdoor vehicle navigation (Prof. Johnson) • Motion in social contexts (Profs. Scheutz and Sabanovic)

50. Platforms Available • GUIs, simulations: • OpenGL (basic 3D GUI) • Player/Stage/Gazebo (mobile robot simulation) • Open Dynamics Engine (rigid body simulation) • Toolkits: • KrisLibrary: math, optimization, kinematics, geometry, motion planning • Motion Planning Toolkit (MPK) • OOPSMP • Robots: • Lynxmotion AL5D hobbyist arm • Segway RMP with laser sensor • Staubli TX90L industrial robot arms • ERA-MOBI mobile robot