Presented by David Stavens. Manipulation Planning Before: Want to move the robot from one configuration to another, around obstacles. Now: Want to robot.

Slides:



Advertisements
Similar presentations
J. P. L a u m o n d L A A S – C N R S M a n i p u l a t i o n P l a n n i n g A Geometrical Formulation.
Advertisements

Solving problems by searching
Heuristic Search techniques
Announcements Course TA: Danny Kumar
Probabilistic Roadmaps. The complexity of the robot’s free space is overwhelming.
Motion Planning for Point Robots CS 659 Kris Hauser.
PRM and Multi-Space Planning Problems : How to handle many motion planning queries? Jean-Claude Latombe Computer Science Department Stanford University.
Manipulation Planning. In 1995 Alami, Laumond and T. Simeon proposed to solve the problem by building and searching a ‘manipulation graph’.
By Lydia E. Kavraki, Petr Svestka, Jean-Claude Latombe, Mark H. Overmars Emre Dirican
Dynamic Bayesian Networks (DBNs)
Best-First Search: Agendas
Probabilistic Roadmap
Kinodynamic Path Planning Aisha Walcott, Nathan Ickes, Stanislav Funiak October 31, 2001.
DESIGN OF A GENERIC PATH PATH PLANNING SYSTEM AILAB Path Planning Workgroup.
Randomized Kinodynamics Motion Planning with Moving Obstacles David Hsu, Robert Kindel, Jean-Claude Latombe, Stephen Rock.
Randomized Motion Planning for Car-like Robots with C-PRM Guang Song and Nancy M. Amato Department of Computer Science Texas A&M University College Station,
Sampling and Connection Strategies for PRM Planners Jean-Claude Latombe Computer Science Department Stanford University.
1 Last lecture  Configuration Space Free-Space and C-Space Obstacles Minkowski Sums.
David Hsu, Robert Kindel, Jean- Claude Latombe, Stephen Rock Presented by: Haomiao Huang Vijay Pradeep Randomized Kinodynamic Motion Planning with Moving.
Deadlock-Free and Collision- Free Coordination of Two Robot Manipulators Patrick A. O’Donnell and Tomás Lozano- Pérez by Guha Jayachandran Guha Jayachandran.
Motion Planning of Multi-Limbed Robots Subject to Equilibrium Constraints. Timothy Bretl Presented by Patrick Mihelich and Salik Syed.
Multi-Arm Manipulation Planning (1994) Yoshihito Koga Jean-Claude Latombe.
1 Single Robot Motion Planning - II Liang-Jun Zhang COMP Sep 24, 2008.
Planning Motions with Intentions By Chris Montgomery A presentation on the paper Planning Motions with Intentions written by Yoshihito Koga, Koichi Kondo,
Planning Paths for Elastic Objects Under Manipulation Constraints Florent Lamiraux Lydia E. Kavraki Rice University Presented by: Michael Adams.
Providing Haptic ‘Hints’ to Automatic Motion Planners Providing Haptic ‘Hints’ to Automatic Motion Planners Burchan Bayazit Joint Work With Nancy Amato.
1 Motion Planning for Multiple Robots B. Aronov, M. de Berg, A. Frank van der Stappen, P. Svestka, J. Vleugels Presented by Tim Bretl.
CS 326A: Motion Planning ai.stanford.edu/~latombe/cs326/2007/index.htm Kinodynamic Planning and Navigation with Movable Obstacles.
Planning Among Movable Obstacles with Artificial Constraints Presented by: Deborah Meduna and Michael Vitus by: Mike Stilman and James Kuffner.
CS 326 A: Motion Planning Manipulation Planning.
1 Path Planning in Expansive C-Spaces D. HsuJ. –C. LatombeR. Motwani Prepared for CS326A, Spring 2003 By Xiaoshan (Shan) Pan.
Presented By: Huy Nguyen Kevin Hufford
NUS CS 5247 David Hsu1 Last lecture  Multiple-query PRM  Lazy PRM (single-query PRM)
Randomized Motion Planning for Car-like Robots with C-PRM Guang Song, Nancy M. Amato Department of Computer Science Texas A&M University College Station,
CS 326A: Motion Planning Kynodynamic Planning + Dealing with Moving Obstacles + Dealing with Uncertainty + Dealing with Real-Time Issues.
Path Planning in Expansive C-Spaces D. HsuJ.-C. LatombeR. Motwani CS Dept., Stanford University, 1997.
Spring 2007 Motion Planning in Virtual Environments Dan Halperin Yesha Sivan TA: Alon Shalita Basics of Motion Planning (D.H.)
Integrated Grasp and Motion Planning For grasping an object in a cluttered environment several tasks need to take place: 1.Finding a collision free path.
Solving problems by searching
1 Single Robot Motion Planning Liang-Jun Zhang COMP Sep 22, 2008.
A Randomized Approach to Robot Path Planning Based on Lazy Evaluation Robert Bohlin, Lydia E. Kavraki (2001) Presented by: Robbie Paolini.
© Manfred Huber Autonomous Robots Robot Path Planning.
Robotics Chapter 5 – Path and Trajectory Planning
Introduction to Robot Motion Planning Robotics meet Computer Science.
Probabilistic Roadmaps for Path Planning in High-Dimensional Configuration Spaces (1996) L. Kavraki, P. Švestka, J.-C. Latombe, M. Overmars.
CS B659: Principles of Intelligent Robot Motion Configuration Space.
October 9, 2003Lecture 11: Motion Planning Motion Planning Piotr Indyk.
On Delaying Collision Checking in PRM Planning – Application to Multi-Robot Coordination By: Gildardo Sanchez and Jean-Claude Latombe Presented by: Michael.
Richard Kelley Motion Planning on a GPU. Last Time Nvidia’s white paper Productive discussion.
Introduction to Motion Planning
Robotics Club: 5:30 this evening
Real-time motion planning for Manipulator based on Configuration Space Chen Keming Cis Peking University.
NUS CS5247 Dynamically-stable Motion Planning for Humanoid Robots Presenter Shen zhong Guan Feng 07/11/2003.
Laboratory of mechatronics and robotics Institute of solid mechanics, mechatronics and biomechanics, BUT & Institute of Thermomechanics, CAS Mechatronics,
Randomized Kinodynamics Planning Steven M. LaVelle and James J
Two Finger Caging of Concave Polygon Peam Pipattanasomporn Advisor: Attawith Sudsang.
Department of Computer Science Columbia University rax Dynamically-Stable Motion Planning for Humanoid Robots Paper Presentation James J. Kuffner,
Randomized KinoDynamic Planning Steven LaValle James Kuffner.
9/30/20161 Path Planning Cognitive Robotics David S. Touretzky & Ethan Tira-Thompson Carnegie Mellon Spring 2012.
Solving problems by searching Chapter 3. Types of agents Reflex agent Consider how the world IS Choose action based on current percept Do not consider.
Solving problems by searching
CS 326A: Motion Planning Probabilistic Roadmaps for Path Planning in High-Dimensional Configuration Spaces (1996) L. Kavraki, P. Švestka, J.-C. Latombe,
On Multi-Arm Manipulation Planning
ECE 448 Lecture 4: Search Intro
Last lecture Configuration Space Free-Space and C-Space Obstacles
Path Planning using Ant Colony Optimisation
Configuration Space of an Articulated Robot
Humanoid Motion Planning for Dual-Arm Manipulation and Re-Grasping Tasks Nikolaus Vahrenkamp, Dmitry Berenson, Tamim Asfour, James Kuffner, Rudiger Dillmann.
Chapter 4 . Trajectory planning and Inverse kinematics
Presentation transcript:

Presented by David Stavens

Manipulation Planning Before: Want to move the robot from one configuration to another, around obstacles. Now: Want to robot to grasp some object and move it to a new location. If this is the only slide you see: – Key ideas very similar. Almost consider object to be another DOF in the configuration space.

Why is this hard? Example. Consider the robot on the left. Want to remove the bar from the “cage”. Cannot be done in one motion! (Also this paper operates in continuous spaces.) Bar Cage

Key Terms CP = Stable Placements of the Object CG = Valid Grasps of the Object by the Robot

Transit Paths A transit path is a path of the robot when it is NOT grasping the object. A transit path is in CP (recall: CP is the set of stable placements) – BUT not all paths in CP are transit paths. – Path must correspond to static object placement. A set of transit paths forms a manifold given a fixed object position.

Transfer Paths Analogously: – A path when the robot IS grasping the object. – Transfer paths are in CG (recall: valid grasps). As before, not all paths in CG are transfer paths. Paths must correspond to a static grasp. – Set of transfer paths forms a manifold for fixed grasp.

Key Idea of the Paper Consider the intersection of CG and CP. – Corresponds to the configurations that are valid grasps paired with valid placements of the object. Essentially, the manipulator may “pick up” or “release” the object at these intersections. So: Connect CG CP components by transit and transfer paths. U

The Algorithm 1.Randomly generate a configuration. 2.Decide at random whether configuration will be used to expand within CG CP connected components OR connect components with transfer/transit paths. 3.Keep configuration if it links two or more components – Determine this by using more basic planner, as usual. U

C-Space Example CP = Valid Placements CG = Valid Grasps Transfer Path Transit Path U CP CG (Not exhaustively labeled.)

Example We connect these CG CP connected components via transfer or transit paths. Connected Components 2 and 3 (Can’t Rotate the Board) Connected component 1 Connected Component 4 U

Transfer/Transit Paths for Example Transfer Path Transit Path

Planning in CG CP Topology “Virtual Joint” between last link and object. Hard to sample into CG CP directly. Paper uses planner from prior work. U U

Paths in CG CP Technically these paths are NOT realizable since they correspond to a change in grasp and a change in object placement all at once. – Unless you’re throwing the object ;-) Paper shows these paths can always be decomposed into transfer and transit paths. – The “reduction property”. (Proved in different paper.) – Notice that reduction property is similar to the transformation process in the PRM Kinodynamics paper: ignore constraints and then transform to obey. U

Planning Transit/Transfer Paths Step 1 – Ignore dynamic object, compute roadmap. Step 2 – Remove edges blocked by object’s position. Step 3 – Search the roadmap with the following caveats:

Possible Search Outcomes Initial Roadmap No path regardless of the obstacle. Path exists regardless of the obstacle. Use Rapidly-exploring Random Trees (RRTs) to bypass obstacle.

Important Caveat (From Kris) Let C1 and C2 be two components. Let G1 and G2 be all grasps in C1 and C2. Let P1 and P2 be all placements in C1 and C2. If G1 and G2 disjoint: can’t use transfer paths. If P1 and P2 disjoint: can’t use transit paths. (I believe algorithm simply fails to find a connection in this case.)

1, 2, 3 4, 5, 6 7, 8, 9

Random Choice of Connectivity Recall algorithm selects randomly whether it will use a generated configuration to expand within the CG CP connected components or to expand the inter-connectivity of those components. Probability of the former: – α ( 1 – estimated_coverage_ratio ) How they determine estimated coverage is cited. Perhaps like PRMs. U

Effect of α

Limitations How does this scale to multiple objects/robots? – (Does reduction property even work?) Maybe hierarchical planning is better: – Symbolic Task Planning – Geometric Manipulation Planning Assumes “pick and place”.

A Note on Uncertainty What about uncertainty? – Object position is uncertain. – Robot motion is uncertain. – Proper locations to grasp object is uncertain. Paper assumes perception will handle this? – Hard problem in general, cluttered environments. Perhaps joint approach is needed that uses some manipulation and some perception.

Learning Valid Grasps (CG) Grasping Previously Unknown Objects More At: STAIR Robot. Prof. Andrew Ng’s group.