Emilio Frazzoli, Munther A. Dahleh and Eric Feron Jingru Luo.

Slides:



Advertisements
Similar presentations
Solving problems by searching
Advertisements

CMSC 471 Fall 2002 Class #5-6 – Monday, September 16 / Wednesday, September 18.
NUS CS5247 Motion Planning for Car- like Robots using a Probabilistic Learning Approach --P. Svestka, M.H. Overmars. Int. J. Robotics Research, 16: ,
CMSC 671 Fall 2005 Class #5 – Thursday, September 15.
Motion Planning for Point Robots CS 659 Kris Hauser.
Techniques for Dealing with Hard Problems Backtrack: –Systematically enumerates all potential solutions by continually trying to extend a partial solution.
NUS CS5247 Motion Planning for Camera Movements in Virtual Environments By Dennis Nieuwenhuisen and Mark H. Overmars In Proc. IEEE Int. Conf. on Robotics.
Probabilistic Path Planner by Someshwar Marepalli Pratik Desai Ashutosh Sahu Gaurav jain.
By Lydia E. Kavraki, Petr Svestka, Jean-Claude Latombe, Mark H. Overmars Emre Dirican
Anytime RRTs Dave Fergusson and Antony Stentz. RRT – Rapidly Exploring Random Trees Good at complex configuration spaces Efficient at providing “feasible”
The Out of Kilter Algorithm in Introduction The out of kilter algorithm is an example of a primal-dual algorithm. It works on both the primal.
Kinodynamic Path Planning Aisha Walcott, Nathan Ickes, Stanislav Funiak October 31, 2001.
NUS CS5247 Randomized Kinodynamic Motion Planning with Moving Obstacles - D. Hsu, R. Kindel, J.C. Latombe, and S. Rock. Int. J. Robotics Research, 21(3): ,
Randomized Kinodynamics Motion Planning with Moving Obstacles David Hsu, Robert Kindel, Jean-Claude Latombe, Stephen Rock.
CPSC 322, Lecture 9Slide 1 Search: Advanced Topics Computer Science cpsc322, Lecture 9 (Textbook Chpt 3.6) January, 23, 2009.
Sum of Subsets and Knapsack
Nonholonomic Multibody Mobile Robots: Controllability and Motion Planning in the Presence of Obstacles (1991) Jerome Barraquand Jean-Claude Latombe.
David Hsu, Robert Kindel, Jean- Claude Latombe, Stephen Rock Presented by: Haomiao Huang Vijay Pradeep Randomized Kinodynamic Motion Planning with Moving.
Footstep Planning Among Obstacles for Biped Robots James Kuffner et al. presented by Jinsung Kwon.
Motion Planning of Multi-Limbed Robots Subject to Equilibrium Constraints. Timothy Bretl Presented by Patrick Mihelich and Salik Syed.
Paper by Kevin M.Lynch, Naoji Shiroma, Hirohiko Arai, and Kazuo Tanie
Multi-vehicle Cooperative Control Raffaello D’Andrea Mechanical & Aerospace Engineering Cornell University u Progress on RoboFlag Test-bed u MLD approach.
1 Single Robot Motion Planning - II Liang-Jun Zhang COMP Sep 24, 2008.
Planning Paths for Elastic Objects Under Manipulation Constraints Florent Lamiraux Lydia E. Kavraki Rice University Presented by: Michael Adams.
On Delaying Collision Checking in PRM Planning G. Sánchez and J. Latombe presented by Niloy J. Mitra.
Probabilistic Roadmaps for Path Planning in High-Dimensional Configuration Spaces Kavraki, Svestka, Latombe, Overmars 1996 Presented by Dongkyu, Choi.
Modeling and Planning with Robust Hybrid Automata Cooperative Control of Distributed Autonomous Vehicles in Adversarial Environments 2001 MURI: UCLA, CalTech,
On Delaying Collision Checking in PRM Planning Gilardo Sánchez and Jean-Claude Latombe January 2002 Presented by Randall Schuh 2003 April 23.
Planning for Humanoid Robots Presented by Irena Pashchenko CS326a, Winter 2004.
Presented By: Huy Nguyen Kevin Hufford
Integrating POMDP and RL for a Two Layer Simulated Robot Architecture Presented by Alp Sardağ.
CS 326A: Motion Planning Kynodynamic Planning + Dealing with Moving Obstacles + Dealing with Uncertainty + Dealing with Real-Time Issues.
Robot Motion Planning Bug 2 Probabilistic Roadmaps Bug 2 Probabilistic Roadmaps.
Branch and Bound Algorithm for Solving Integer Linear Programming
CS 326 A: Motion Planning Collision Detection and Distance Computation.
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.
Backtracking.
Probabilistic Roadmaps for Path Planning in High-Dimensional Configuration Spaces Kavraki, Svestka, Latombe, Overmars 1996 Presented by Chris Allocco.
Multi-vehicle Cooperative Control Raffaello D’Andrea Mechanical & Aerospace Engineering Cornell University u Progress on RoboFlag Test-bed u MLD approach.
NUS CS5247 Motion Planning for Humanoid Robots Presented by: Li Yunzhen.
Feedback Control for Steering Needles Through 3D Deformable Tissue Using Helical Paths Kris Hauser, Ron Alterovitz, Nuttapon Chentanez, Allison Okamura,
A Randomized Approach to Robot Path Planning Based on Lazy Evaluation Robert Bohlin, Lydia E. Kavraki (2001) Presented by: Robbie Paolini.
Anna Yershova Dept. of Computer Science University of Illinois
Real Time Motion Planning. Introduction  What is Real time Motion Planning?  What is the need for real time motion Planning?  Example scenarios in.
Path Planning for a Point Robot
Probabilistic Roadmaps for Path Planning in High-Dimensional Configuration Spaces (1996) L. Kavraki, P. Švestka, J.-C. Latombe, M. Overmars.
On Delaying Collision Checking in PRM Planning – Application to Multi-Robot Coordination By: Gildardo Sanchez and Jean-Claude Latombe Presented by: Michael.
Applications of Dynamic Programming and Heuristics to the Traveling Salesman Problem ERIC SALMON & JOSEPH SEWELL.
Nearest Neighbor Queries Chris Buzzerd, Dave Boerner, and Kevin Stewart.
Lecture 3: Uninformed Search
Types of Algorithms. 2 Algorithm classification Algorithms that use a similar problem-solving approach can be grouped together We’ll talk about a classification.
Tree-Growing Sample-Based Motion Planning
Searching for Solutions
Motion Primitives for an Autorotating Helicopter Sanjiban Choudhury.
Randomized Kinodynamics Planning Steven M. LaVelle and James J
Planning Under Uncertainty. Sensing error Partial observability Unpredictable dynamics Other agents.
Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012, Chapter 12: Slide 1 Chapter 12 Path Planning.
Randomized KinoDynamic Planning Steven LaValle James Kuffner.
Optimal Acceleration and Braking Sequences for Vehicles in the Presence of Moving Obstacles Jeff Johnson, Kris Hauser School of Informatics and Computing.
Solving problems by searching
Instructor Prof. Shih-Chung Kang 2008 Spring
CS 326A: Motion Planning Probabilistic Roadmaps for Path Planning in High-Dimensional Configuration Spaces (1996) L. Kavraki, P. Švestka, J.-C. Latombe,
CS b659: Intelligent Robotics
The minimum cost flow problem
ECE 448 Lecture 4: Search Intro
Types of Algorithms.
Motion Planning for a Point Robot (2/2)
Configuration Space of an Articulated Robot
Chapter 4 . Trajectory planning and Inverse kinematics
Lecture 4: Tree Search Strategies
Presentation transcript:

Emilio Frazzoli, Munther A. Dahleh and Eric Feron Jingru Luo

Background  Kinodynamic motion planning  A new randomized incremental algorithm System’s dynamics An environment with moving obstacles Efficiency Safety guarantee Optimal solution Probabilistic complete Guaranteed performance

Framework  System Dynamics Ordinary Differential Equations(ODEs) Equilibrium points (zero velocity) (1) (2)

Framework  Obstacle-Free Guidance System Optimal cost-to-go function for all Compute the optimal control policy (5) (6) x

Framework  Notation ○ Feasible set F for all (state, time) pairs satisfying all constraints ○ Reachable set Given, is reachable if find x

Framework  Problem Formulation Given an initial state at time, and a goal, find that can steer the system from to Optimal trajectory to minimize the cost

Motion Planning  Basic idea Initial condition Random equilibrium point Target

Data Structure  Node (state, time) couple Total cost ○ Accumulated cost by bookkeeping ○ Cost-to-go Lower bound: optimal cost function Upper bound: infinity  Edge The randomly generated equilibrium point Cost along the edge

Initialization  Root node: some point in the future Contains the initial condition As an example:, moving at, and we devote s to the computation, the root node must be set at Total cost: ○ Accumulated cost: set to zero ○ Cost-to-go Lower bound: optimal cost function Upper bound: infinity A B

Tree Expansion Step  Two points: Which node to expand In which direction to explore ○ Samples a random configuration, and try to expand all nodes in order of increasing cost ○ Apply the optimal control policy until the system gets to endgame region of

Initial state Random Equilibrium point Target 1 2 3

Real-Time Consideration  Safety Check Moving obstacles Collision check at time point is not enough Check safety over a time ○ safety A milestone (x, t) is τ-safe if (x, t) is feasible for all t ∈ [t,t+τ]

Real-Time Consideration  Improving performance Trajectories from equilibrium to equilibrium provide unsatisfactory performance Primary milestone Secondary milestone, split the new edge into n segments and add the breakpoints Primary milestone Secondary milestone

Update Cost  Look for the optimal trajectory When a solution is found Upper bound on the cost-to-go are updated Update backward to the root ○ Parent.U.B.> node.U.B.+ edge_cost ○ Parent.U.B  node.U.B.+ edge_cost Initial state Target Xnew

Tree Pruning  Upper bound and lower bound Lower bound: optimal cost-to-go in free environment Upper bound: cost of the best trajectory from the milestone to the destination or +∞ Every time a solution is found, prune subtree while updating the node ○ lower bound + edge cost > upper bound current node

Initial state Random point Target x L: 10 U: 10 L: 15 U: +∞ 2 L: 25 U: +∞ 1 L: 35 U: +∞ 10 L: 20 U: +∞ L: 22 U: +∞ L: 25 U: +∞ L: 15 U: 20 L: 20 U: 25 L: 22 U: 30 L: 25 U:

Initial state Random point Target Complete Algorithm Initialization Loop if trajectory(root, target) collison free thenreturn success loop newTrajectory=Expand-Tree if newTrajectory != failure and safe then get Primary and Second M.S. for all new M.S. do Update-Cost and Prune-Tree until Time is up if feasible solution found then root  best child else if root has children then root  random child else generate another root

Application Example  Four planners A: one node, chosen randomly B: one node, chosen as the closest one C: all node sorted in random order D: all node sorted in the order of increasing distance

Application Example  Ground robot moving among fixed spheres  Helicopter moving among fixed spheres The planners handle easily

Application Example  Ground robot moving through sliding doors C, D perform better Algorithm AAlgorithm D

Application Example  Helicopter moving through sliding doors C, D perform better while A failed Algorithm BAlgorithm D

Conclusion  Deal with system dynamics efficiently  Decouple between the high-level motion plan and low-level control tasks  Real time issues Finite computation time Safety check Exploration strategy  Future work Motion plan in the uncertain environment