Eric Feron/MIT 02/2000 Trajectory Planning and System dynamics Eric Feron Laboratory for Information and Decision Systems (LIDS) Dept Aeronautics and Astronautics.

Slides:



Advertisements
Similar presentations
Lecture 20 Dimitar Stefanov. Microprocessor control of Powered Wheelchairs Flexible control; speed synchronization of both driving wheels, flexible control.
Advertisements

Reactive and Potential Field Planners
Lect.3 Modeling in The Time Domain Basil Hamed
Kinematic Synthesis of Robotic Manipulators from Task Descriptions June 2003 By: Tarek Sobh, Daniel Toundykov.
Motion Planning for Point Robots CS 659 Kris Hauser.
Synchronous Maneuvering of Uninhabited Air Vehicles
The robot structure model design 2 Curse 5. Modeling: the robot AcTrMStTk V(t) T(t)  (t) q(t) x(t)
Manipulator Dynamics Amirkabir University of Technology Computer Engineering & Information Technology Department.
Emilio Frazzoli, Munther A. Dahleh and Eric Feron Jingru Luo.
More MR Fingerprinting
Trajectory Generation
Kinodynamic Path Planning Aisha Walcott, Nathan Ickes, Stanislav Funiak October 31, 2001.
Randomized Kinodynamics Motion Planning with Moving Obstacles David Hsu, Robert Kindel, Jean-Claude Latombe, Stephen Rock.
Design of Attitude and Path Tracking Controllers for Quad-Rotor Robots using Reinforcement Learning Sérgio Ronaldo Barros dos Santos Cairo Lúcio Nascimento.
Image Segmentation and Active Contour
Introduction to Control: How Its Done In Robotics R. Lindeke, Ph. D. ME 4135.
Multi-Robot Motion Planning Jur van den Berg. Outline Recap: Configuration Space for Single Robot Multiple Robots: Problem Definition Multiple Robots:
Nonholonomic Multibody Mobile Robots: Controllability and Motion Planning in the Presence of Obstacles (1991) Jerome Barraquand Jean-Claude Latombe.
A De-coupled Sliding Mode Controller and Observer for Satellite Attitude Control Ronald Fenton.
Multi-Arm Manipulation Planning (1994) Yoshihito Koga Jean-Claude Latombe.
CSCE 641: Forward kinematics and inverse kinematics Jinxiang Chai.
Modeling and Planning with Robust Hybrid Automata Cooperative Control of Distributed Autonomous Vehicles in Adversarial Environments 2001 MURI: UCLA, CalTech,
Optimizing Schedules for Prioritized Path Planning of Multi-Robot Systems Maren Bennewitz Wolfram Burgard Sebastian Thrun.
1 Hybrid Agent-Based Modeling: Architectures,Analyses and Applications (Stage One) Li, Hailin.
Continuum Crowds Adrien Treuille, Siggraph 王上文.
ME Robotics DIFFERENTIAL KINEMATICS Purpose: The purpose of this chapter is to introduce you to robot motion. Differential forms of the homogeneous.
Manipulator Dynamics Amirkabir University of Technology Computer Engineering & Information Technology Department.
Chapter 5: Path Planning Hadi Moradi. Motivation Need to choose a path for the end effector that avoids collisions and singularities Collisions are easy.
Course AE4-T40 Lecture 2: 2D Models Of Kite and Cable.
Mobile Robotics: 11. Kinematics 2
DAMN : A Distributed Architecture for Mobile Navigation Julio K. Rosenblatt Presented By: Chris Miles.
Introduction to ROBOTICS
CL A Coordinated Flight of Uninhabited Air Vehicles Olivier Laplace Princeton University FAA/NASA Joint University Program Quarterly Review - April, 2001.
Robot Motion Planning Computational Geometry Lecture by Stephen A. Ehmann.
Definition of an Industrial Robot
Motion Control (wheeled robots)
1 CMPUT 412 Motion Control – Wheeled robots Csaba Szepesvári University of Alberta TexPoint fonts used in EMF. Read the TexPoint manual before you delete.
Constraints-based Motion Planning for an Automatic, Flexible Laser Scanning Robotized Platform Th. Borangiu, A. Dogar, A. Dumitrache University Politehnica.
World space = physical space, contains robots and obstacles Configuration = set of independent parameters that characterizes the position of every point.
20/10/2009 IVR Herrmann IVR: Introduction to Control OVERVIEW Control systems Transformations Simple control algorithms.
MAE 242 Dynamics – Section I Dr. Kostas Sierros.
TUTORIAL on LOGIC-BASED CONTROL Part I: SWITCHED CONTROL SYSTEMS Daniel Liberzon Coordinated Science Laboratory and Dept. of Electrical & Computer Eng.,
Chapter 5 Trajectory Planning 5.1 INTRODUCTION In this chapters …….  Path and trajectory planning means the way that a robot is moved from one location.
Chapter 5 Trajectory Planning 5.1 INTRODUCTION In this chapters …….  Path and trajectory planning means the way that a robot is moved from one location.
Robotics Chapter 5 – Path and Trajectory Planning
Probabilistic Roadmaps for Path Planning in High-Dimensional Configuration Spaces (1996) L. Kavraki, P. Švestka, J.-C. Latombe, M. Overmars.
1 Fundamentals of Robotics Linking perception to action 2. Motion of Rigid Bodies 南台科技大學電機工程系謝銘原.
20/10/2009 IVR Herrmann IVR:Control Theory OVERVIEW Control problems Kinematics Examples of control in a physical system A simple approach to kinematic.
Progress in identification of damping: Energy-based method with incomplete and noisy data Marco Prandina University of Liverpool.
ZMP-BASED LOCOMOTION Robotics Course Lesson 22.
UNC Chapel Hill M. C. Lin Introduction to Motion Planning Applications Overview of the Problem Basics – Planning for Point Robot –Visibility Graphs –Roadmap.
Motivation For analytical design of control systems,
Trajectory Generation
City College of New York 1 John (Jizhong) Xiao Department of Electrical Engineering City College of New York Mobile Robot Control G3300:
Optimal Path Planning Using the Minimum-Time Criterion by James Bobrow Guha Jayachandran April 29, 2002.
Randomized Kinodynamics Planning Steven M. LaVelle and James J
Autonomous Robots Robot Path Planning (3) © Manfred Huber 2008.
Randomized KinoDynamic Planning Steven LaValle James Kuffner.
Intelligent Robot Lab Pusan National University Intelligent Robot Lab Chapter 7. Forced Response Errors Pusan National University Intelligent Robot Laboratory.
Physically-Based Motion Synthesis in Computer Graphics
Optimal Acceleration and Braking Sequences for Vehicles in the Presence of Moving Obstacles Jeff Johnson, Kris Hauser School of Informatics and Computing.
Instructor Prof. Shih-Chung Kang 2008 Spring
Character Animation Forward and Inverse Kinematics
CS b659: Intelligent Robotics
Sérgio Ronaldo Barros dos Santos Cairo Lúcio Nascimento Júnior
Zaid H. Rashid Supervisor Dr. Hassan M. Alwan
Locomotion of Wheeled Robots
Autonomous Cyber-Physical Systems: Dynamical Systems
Robust Belief-based Execution of Manipulation Programs
Chapter 4 . Trajectory planning and Inverse kinematics
Presentation transcript:

Eric Feron/MIT 02/2000 Trajectory Planning and System dynamics Eric Feron Laboratory for Information and Decision Systems (LIDS) Dept Aeronautics and Astronautics

Eric Feron/MIT 02/2000 Point of this lecture System dynamics is very important for robotic systems which aim at moving fast - anything that flies in particular.

Eric Feron/MIT 02/2000 Outline Motivation: ground, space and air vehicles Trajectory planning: fundamental requirements System dynamics: introduction / reminder Some approaches to integrate system dynamics and trajectory planning: –Frequency separation –Inverse control –“Intuitive control” –Recent approaches Conclusions

Eric Feron/MIT 02/2000 Ground, space and air vehicles Egg on the groundEgg in outer space Egg that was up in the air Full mastery of dynamics is entry level for aerobotics Simulated eggs are OK for a while.

Eric Feron/MIT 02/2000 From Dynamics to Trajectory Planning Trajectory Generation Interaction with Surrounding Environment: Other vehicles, obstacles Inner loop control Inner loop, physical model Towards Mission Planning "Robotics" "GN&C"

Eric Feron/MIT 02/2000 Trajectory Planning Today Probabilistic Roadmap Methods Probabilistic Completeness Latombe, Kavraki - Overmars, Svestka Kinodynamic Trajectory Planning Latombe, LaValle, Kuffner, INRIA Time-optimality Reif, Zefran Complexity analysis Canny, Donald, Reif, Xavier Moving Obstacles Fiorini, Shiller Potential field methods Khatib, Latombe, Barraquand

Eric Feron/MIT 02/2000 Trajectory Planning A B Configuration space (Lozano- Peres) A B Potential field approaches, dynamic programming A B Randomization schemes (Latombe, Motwani) A B Randomly exploring trees (LaValle)

Eric Feron/MIT 02/2000 Fundamentals of vehicle dynamics: Notion of State Vehicle system: Vehicle state: All variables that are necessary to know at instant t to predict behavior of vehicle in the future (given future inputs to the system). Example: Cart sliding on a surface: Inputs (accelerations, steering wheel angle, etc) Outputs (vehicle position, attitude, health). F State?

Eric Feron/MIT 02/2000 State and Equations of Motion Implicit in notion of state is that of equation of motion –Continuous: x is state (position, attitude, speeds of all sorts), u is control, w is perturbation. –Discrete: –We’ll see both brands in this course. CS seems to like second brand better. ODEs must also be accounted for. –Fancy buzzword: hybrid systems.

Eric Feron/MIT 02/2000 Beating the complexity hurdle in trajectory planning Trajectory planning is very complex, for very many reasons: environment complexity (obstacles, vehicle shape), dynamics complexity: Equations of motion with many, many states. Makes straight application of standard planning paradigms (e.g. Dynamic Programming) computationally intractable on initial models Need for complexity reduction. Hierarchical decomposition of the control tasks: –Maneuver sequencing (guidance, trajectory planning –Maneuver execution (control, trajectory tracking)

Eric Feron/MIT 02/2000 Complexity Reduction via frequency separation Basic axiom: the “dynamics” of the trajectory is very slow, thus uncoupled from the dynamics of the vehicle: path planning for jetliner. Waypoints Trajectory represented by piecewise linear functions, although system cannot physically make sharp turns: no one cares. Also applied for many current flying robots: Can’t always do that. Draper-MIT-BU TSK Base.

Eric Feron/MIT 02/2000 Trajectory regulation/tracking Once a trajectory is given, must be able to track it: Nominal trajectory yd==> nominal inputs (trim values) ud ==> (+perturbations, unmodeled dynamics) yields actual trajectory y ==> use y-yd to generate a correction signal du, which will make sure it stays close to zero. System ud y yd - + Logic (usually PID) + + du

Eric Feron/MIT 02/2000 Complexity reduction from fundamental insight Map vehicle dynamics onto achievable trajectories Inverse Control Feedback Linearization Differential Flatness Trajectory specification in output space (geometrical coordinates) is enough for trajectory specification in control space.

Eric Feron/MIT 02/2000 Trajectory Generation Example Inverse Control and Feedback Control of a Cart Protoype problem: Steering a cart on a plane to follow a given trajectory. Also applies to many types of airplanes, helicopters, etc. Fliess, Rouchon, Sastry, Murray.

Eric Feron/MIT 02/2000 Steering a cart: Interface between Trajectory Planning and Control A cart: Two controls Reference Trajectory: Two variables One problem: If use steering wheel position as reference for trajectory following, then not only need to know trajectory, but also initial position/oientation of cart to find out controls. e.g. May have to steer or left (and of course apply opposite sign moments) to follow reference trajectory. A control systems nightmare if inertial effects are significant.

Eric Feron/MIT 02/2000 Steering a cart: Appropriate Interfacing through “Differential flatness” One elegant solution: The middle of rear axle tracks the reference trajectory. Named Flat Output: The reference trajectory unambiguously specifies the controls to be applied to the cart. Notice: the trajectory r(t) must be continuously differentiable at least a few times with respect to time (also assume no geometrical singularities to make matters simpler) r(t)

Eric Feron/MIT 02/2000 Steering a cart: Technical details r(t) Parameterize trajectory by curvilinear coordinates: s(t): Curvilinear abscissa.  (t): Cart angular speed. Cart equations of motion: F: Forward force, directly proportional to (algebraic) sum of torques applied to rear wheels (for example). M: Torque, directly proportional to (algebraic) difference of torques applied to rear wheels. Can convert these into other combinations like torque/direction of front wheel or direction of front wheel + torque on rear axle for rear wheel drives. For a given r(t), the derivatives of s(t) and those of  (t) are unambiguously determined. So the controls on the vehicle (force and torque) are uniquely determined as a function of r(t).

Eric Feron/MIT 02/2000 A Feedback control strategy / tracking system for cart steering (x,y) (xd,yd) Step 1: Given (x,y) and (xd,yd) (desired trajectory), design a proportional, derivative, tracking system, that is design (x,y) such that These behaviors are “stable” for positive K and D, and (x,y) converge towards desired trajectory. Step 2: Extract from (x,y) and apply corresponding force, moment to cart. It works. You show it in HW.

Eric Feron/MIT 02/2000 Complexity reduction via dynamics discretization A reduction in the complexity of the problem comes from the decomposition of feasible trajectories into trajectory primitives

Eric Feron/MIT 02/2000 Trim trajectories: trajectories along which velocities in body axes and control inputs are constant –Symmetry  trim trajectories are the composition of a constant rotation g 0  {0}  SO(3) and a screw motion h(t)=exp(  t), where   h  se(3) – h(t) in the physical space can be visualized as a helix flown at a constant sideslip angle –Trim trajectories can be parameterized by , or equivalently by: Trajectory Primitives – Trim Trajectories Usual parametrization: V: velocity  : fligt path angle d  /dt: turning rate  : sideslip angle Usual parametrization: V: velocity  : fligt path angle d  /dt: turning rate  : sideslip angle

Eric Feron/MIT 02/2000 Trajectory Primitives - Maneuvers Maneuver: (Finite time) (Fast) transition between trim points Maneuver: (Finite time) (Fast) transition between trim points “Aerobatics”: loop barrel roll flip split-s... “Aerobatics”: loop barrel roll flip split-s... Transitions to and from: hover forward flight turning flight climbs/dives Transitions to and from: hover forward flight turning flight climbs/dives  g

Eric Feron/MIT 02/2000 Vehicle maneuvers

Eric Feron/MIT 02/2000 Split-S I/O Observations Trimmed forward flight Pitch cyclic Collective Pitch cyclic Rev. Coll. Roll cyclic Roll cyclic Maneuver Initiation Roll Angle= 90 deg Roll angle =145deg Pitch angle =45deg Pitch angle =0deg "Intuitive control" Pratt & Raibert

Eric Feron/MIT 02/2000 Maneuver Automaton The state of the system is fully described by: –trajectory primitive being executed (q  Q  N) –inception time (t 0  R) and “position” (h 0  R 4 ) –Current time (t  R) Maneuvers have a time duration, while trim trajectories can be followed indefinitely The hybrid controller must provide: –jump destination (q’  Q, which maneuver to execute) –coasting time (t’-t 0, how long should we wait in the trim trajectory before initiating the maneuver)

Eric Feron/MIT 02/2000 Robust Hybrid Automaton For each trim trajectory, define the following: – L q : limit set – R q : recoverability set – C q : maneuver start set –  q : maneuver end set

Eric Feron/MIT 02/2000 Given - Running cost: Find a Control policy: To minimize the Total cost: Subject to the System dynamics: Optimal cost satisfies the HJB eq.: Solving the HJB equation is still difficult, however we have reduced the dimension of the state to 4 continuous dimension + 1 discrete dimension  solvable through approximation architectures Optimal Control Problem

Eric Feron/MIT 02/2000 Neuro-Dynamic Programming Formulation Assume we know a proper policy  0, that is a policy that for all possible initial states results in a finite cost J 0 (e.g. from heuristics, or other considerations) A no worse policy is given by The iteration converges; technical conditions for convergence to optimal cost In general, we have some approximate representation of J i (look-up tables, approximation architectures) J i depends on a “small” number of parameters, and has to be computed only on compact sets (computational tractability) The optimal control is computed by an optimization over time, and a discrete set (applicability to real-time systems)

Eric Feron/MIT 02/2000 Simulation Example Initial conditions: High speed flight over target

Eric Feron/MIT 02/2000 Motion planning with obstacles Traditional path planning –techniques based on the configuration space (Lozano-Perez), e.g. A* searches – does not deal with system dynamics - deals with complex geometric environmnets Kinodynamic planning –state space –Potential field techniques: can get stuck in local minima –Randomized techniques, e.g. randomized roadmap (Latombe 96), Rapidly-exploring Random Trees (LaValle 99): probabilistic completeness An attractive alternative to the full state space is the maneuver space

Eric Feron/MIT 02/2000 Motion Planning algorithm Based on Rapidly-exploring Random Trees algorithm (LaValle, 99) Optimal cost function in the free workspace case provides: –pseudo-metric on the hybrid space –Fast and efficient computation of “optimal” control

Eric Feron/MIT 02/2000 Maneuver Tree - Threat avoidance

Eric Feron/MIT 02/2000 Motion planning demo: threat avoidance

Eric Feron/MIT 02/2000 Maneuver Tree - “Maze”

Eric Feron/MIT 02/2000 Maneuver Tree - “Sliding doors”