Video 8.1 Vijay Kumar. Property of University of Pennsylvania, Vijay Kumar

Similar documents
Adaptive Robust Tracking Control of Robot Manipulators in the Task-space under Uncertainties

EML5311 Lyapunov Stability & Robust Control Design

Lecture 9 Nonlinear Control Design

Robot Manipulator Control. Hesheng Wang Dept. of Automation

Introduction to centralized control

NMT EE 589 & UNM ME 482/582 ROBOT ENGINEERING. Dr. Stephen Bruder NMT EE 589 & UNM ME 482/582

Control of Robotic Manipulators

EN Nonlinear Control and Planning in Robotics Lecture 3: Stability February 4, 2015

q 1 F m d p q 2 Figure 1: An automated crane with the relevant kinematic and dynamic definitions.

Control of Mobile Robots

Introduction to centralized control

Robotics. Dynamics. University of Stuttgart Winter 2018/19

General procedure for formulation of robot dynamics STEP 1 STEP 3. Module 9 : Robot Dynamics & controls

Exponential Controller for Robot Manipulators

Robust Control of Robot Manipulator by Model Based Disturbance Attenuation

Dynamics. Basilio Bona. Semester 1, DAUIN Politecnico di Torino. B. Bona (DAUIN) Dynamics Semester 1, / 18

CONTROL OF ROBOT CAMERA SYSTEM WITH ACTUATOR S DYNAMICS TO TRACK MOVING OBJECT

Video 6.1 Vijay Kumar and Ani Hsieh

The... of a particle is defined as its change in position in some time interval.

Stability of Nonlinear Systems An Introduction

Review: control, feedback, etc. Today s topic: state-space models of systems; linearization

Control of industrial robots. Centralized control

Lecture «Robot Dynamics»: Dynamics and Control

Lecture «Robot Dynamics»: Dynamics 2

System Control Engineering

Lyapunov stability ORDINARY DIFFERENTIAL EQUATIONS

Automatic Control 2. Nonlinear systems. Prof. Alberto Bemporad. University of Trento. Academic year

Outline. Input to state Stability. Nonlinear Realization. Recall: _ Space. _ Space: Space of all piecewise continuous functions

Stability lectures. Stability of Linear Systems. Stability of Linear Systems. Stability of Continuous Systems. EECE 571M/491M, Spring 2008 Lecture 5

Robotics. Dynamics. Marc Toussaint U Stuttgart

Dynamics. 1 Copyright c 2015 Roderic Grupen

Video 1.1 Vijay Kumar and Ani Hsieh

Lecture 9 Nonlinear Control Design. Course Outline. Exact linearization: example [one-link robot] Exact Feedback Linearization

Trigonometric Saturated Controller for Robot Manipulators

Video 5.1 Vijay Kumar and Ani Hsieh

Translational and Rotational Dynamics!

Control Systems. Internal Stability - LTI systems. L. Lanari

Delay-independent stability via a reset loop

Section 5.4 (Systems of Linear Differential Equation); 9.5 Eigenvalues and Eigenvectors, cont d

2 Lyapunov Stability. x(0) x 0 < δ x(t) x 0 < ɛ

Nonlinear PD Controllers with Gravity Compensation for Robot Manipulators

Artificial Intelligence & Neuro Cognitive Systems Fakultät für Informatik. Robot Dynamics. Dr.-Ing. John Nassour J.

Chapter #4 EEE8086-EEE8115. Robust and Adaptive Control Systems

ADAPTIVE FORCE AND MOTION CONTROL OF ROBOT MANIPULATORS IN CONSTRAINED MOTION WITH DISTURBANCES

Video 2.1a Vijay Kumar and Ani Hsieh

DO NOT DO HOMEWORK UNTIL IT IS ASSIGNED. THE ASSIGNMENTS MAY CHANGE UNTIL ANNOUNCED.

Topic # /31 Feedback Control Systems. Analysis of Nonlinear Systems Lyapunov Stability Analysis

Lecture 14: Ordinary Differential Equation I. First Order

Georgia Institute of Technology Nonlinear Controls Theory Primer ME 6402

Inverse differential kinematics Statics and force transformations

STABILITY ANALYSIS OF DYNAMIC SYSTEMS

MCE/EEC 647/747: Robot Dynamics and Control. Lecture 8: Basic Lyapunov Stability Theory

The Acrobot and Cart-Pole

Rigid Manipulator Control

Neural Network-Based Adaptive Control of Robotic Manipulator: Application to a Three Links Cylindrical Robot

Quaternion-Based Tracking Control Law Design For Tracking Mode

Mechanics. In the Science Program, Mechanics contributes to the following program goals described in the Exit Profile:

Analysis and Design of Hybrid AI/Control Systems

Robot Dynamics II: Trajectories & Motion

Quadrotor Modeling and Control

Lyapunov Stability Theory

DO NOT DO HOMEWORK UNTIL IT IS ASSIGNED. THE ASSIGNMENTS MAY CHANGE UNTIL ANNOUNCED.

Adaptive fuzzy observer and robust controller for a 2-DOF robot arm Sangeetha Bindiganavile Nagesh

A HYBRID SYSTEM APPROACH TO IMPEDANCE AND ADMITTANCE CONTROL. Frank Mathis

Robust Control of Cooperative Underactuated Manipulators

Case Study: The Pelican Prototype Robot

Chapter 8: Momentum, Impulse, & Collisions. Newton s second law in terms of momentum:

Robotics 1 Inverse kinematics

Robotics 1 Inverse kinematics

A Sliding Mode Controller Using Neural Networks for Robot Manipulator

Observer Based Output Feedback Tracking Control of Robot Manipulators

Hybrid Control and Switched Systems. Lecture #7 Stability and convergence of ODEs

Dynamics. describe the relationship between the joint actuator torques and the motion of the structure important role for

CONTROL OF THE NONHOLONOMIC INTEGRATOR

A Sliding Mode Control based on Nonlinear Disturbance Observer for the Mobile Manipulator

A Physically-Based Fault Detection and Isolation Method and Its Uses in Robot Manipulators

Nonlinear Systems and Control Lecture # 12 Converse Lyapunov Functions & Time Varying Systems. p. 1/1

MCE 366 System Dynamics, Spring Problem Set 2. Solutions to Set 2

Quaternion Feedback Regulation of Underwater Vehicles Ola-Erik FJELLSTAD and Thor I. FOSSEN Abstract: Position and attitude set-point regulation of au

Physics A - PHY 2048C

Balancing of an Inverted Pendulum with a SCARA Robot

Nonlinear Control Lecture 4: Stability Analysis I

Lecture Schedule Week Date Lecture (M: 2:05p-3:50, 50-N202)

Kinematics (special case) Dynamics gravity, tension, elastic, normal, friction. Energy: kinetic, potential gravity, spring + work (friction)

Trajectory tracking & Path-following control

Video 3.1 Vijay Kumar and Ani Hsieh

Position in the xy plane y position x position

MSMS Basilio Bona DAUIN PoliTo

Advanced Robotic Manipulation

In this section of notes, we look at the calculation of forces and torques for a manipulator in two settings:

2.003 Quiz #1 Review

Nonlinear System Analysis

Stabilization and Passivity-Based Control

(W: 12:05-1:50, 50-N202)

Virtual Passive Controller for Robot Systems Using Joint Torque Sensors

Design and Control of Variable Stiffness Actuation Systems

2007 Problem Topic Comment 1 Kinematics Position-time equation Kinematics 7 2 Kinematics Velocity-time graph Dynamics 6 3 Kinematics Average velocity

Operational Space Control of Constrained and Underactuated Systems

Delay-Independent Stabilization for Teleoperation with Time Varying Delay

MCE693/793: Analysis and Control of Nonlinear Systems

Transcription:

Video 8.1 Vijay Kumar 1

Definitions State State equations Equilibrium 2

Stability Stable Unstable Neutrally (Critically) Stable 3

Stability Translate the origin to x e x(t) =0 is stable (Lyapunov stable) if and only if for any e > 0, there exists a d(e) > 0 such that x 2 d e x 1 x(t) =0 is asymptotically stable if and only if it is stable and there exists a d > 0 such that 4

Asymptotic Stability x 2 d x 1 x(t) =0 is asymptotically stable if and only if it is stable and there exists a d > 0 such that x(t) =0 is globally asymptotically stable if and only if it is asymptotically stable and it is independent of x(t 0 ) 5

Example Viscous friction, c x 2 q x 1 m E(t) cannot increase Suppose you want x 1 6 6

Global Asymptotic Stability of Linear Systems Global Asymptotic Stability if and only if the real parts of all eigenvalues of A are negative Lyapunov Stability, not Global Asymptotic Stability if and only if the real parts of all eigenvalues are non positive, and zero eigenvalue is not repeated Unstable if and only if there is one eigenvalue of A whose real part is positive 7

Linear Autonomous Systems Solution eigenvectors eigenvalues Exponential of a matrix, X for non defective A but similar story for defective A Eigenvalues and eigenvectors for non defective X 8

Video 8.2 Vijay Kumar 9

Stability of Almost Linear Systems Global Asymptotic Stability if and only if the real parts of all eigenvalues of A are negative Lyapunov Stability, not Global Asymptotic Stability if and only if the real parts of all eigenvalues are non positive, and zero eigenvalue is not repeated Not Significant Significant dynamics Unstable if and only if there is one eigenvalue of A whose real part is positive 10

Lyapunov s theorem Nonlinear, autonomous systems Near equilibrium points If the linearized system exhibits significant behavior, then the stability characteristics of the nonlinear system near the equilibrium point are the same as that of the linear system. 11

Example Equation of motion Viscous friction, c State space representation Equilibrium points Change of variables 12

Example Equilibrium point number 1 Viscous friction, c Equilibrium point number 2 q m 13

Example Equilibrium point number 1 Viscous friction, c Linearization q m If c>0 and g>0, real parts of both eigenvalues are always negative The system is locally asymptotically stable 14

Example Equilibrium point number 2 Viscous friction, c Linearization q m If c>0 and g>0, both eigenvalues are real, one is positive. The system is unstable 15

Example (c=0) Equilibrium point number 1 No friction q Linearization m Real parts of both eigenvalues are non negative No conclusive results 16

Summary for Nonlinear Autonomous Systems Write equations of motion in state space notation Solve f(x)=0 Identify equilibrium point(s), x e Linearize equations of motion to get the coefficient matrix A Compute eigenvalues of A. Use Lyapunov s theorem. If the linearized system have significant dynamics, we can make an inference about stability. 17

Lyapunov s Direct Method Avoids linearization (hence direct) 18

Example Viscous friction, c x 2 q x 1 m E(t) cannot increase 19

Lyapunov s Direct Method V(x) is a continuous function with continuous first partial derivatives V(x) is positive definite Such a function V is called a Lyapunov Function Candidate V acts like a norm What if you can show that V never increases? 20

Theorem 1. The (above) system is stable if there exists a Lyapunov function candidate such that the time derivative of V is negative semi-definite along all solution trajectories of the system. 21

Theorem 2. The (above) system is asymptotically stable if there exists a Lyapunov function candidate such that the time derivative of V is negative definite along all solution trajectories of the system. 22

Example 1 Equation of motion Viscous friction, c State space representation q Equilibrium point What is a candidate Lyapunov function? m 23

Example 1 Viscous friction, c q m 24

Example 2 One-dimensional spring-mass-dashpot with a nonlinear spring x k O M What is a candidate Lyapunov function? Linearized system does not have significant dynamics 25

Video 8.3 Vijay Kumar 26

Fully-actuated robot arm (n joints, n actuators) Equations of Motion symmetr ic, positive definite inertia matrix n- dimensiona l vector of Coriolis and centripetal forces n- dimensi onal vector of gravitati onal forces n- dimensi onal vector of actuator forces and torques 27

Fully-actuated robot arm (continued) 28

PD Control of Robot Arms Reference trajectory Error assume Proportional + Derivative Control 29

Assume no gravitational forces PD Control achieves Global Asymptotic Stability Lyapunov function candidate Proof 0 Identity 30

Assume no gravitational forces PD Control achieves Global Asymptotic Stability Lyapunov function candidate Proof - decreasing as long as velocity is non zero can it reach a state where? 31

Assume no gravitational forces PD Control achieves Global Asymptotic Stability Proof decreasing as long as velocity is non zero can it reach a state where La Salle s theorem guarantees Global Asymptotic Stability 32

With gravitational forces PD Control achieves Global Asymptotic Stability but with a new equilibrium point g q 33

PD control with gravity compensation Global Asymptotic Stability with the correct equilibrium configuration Use the same Lyapunov function candidate: 34

Computed Torque Control Reference trajectory Compensate for gravity and inertial forces Global Asymptotic Stability 35

Computed Torque Control and Feedback Linearization v u y nonline ar feedbac k new system original system Nonlinear feedback transforms the original nonlinear system to a new linear system Linearization is exact (distinct from linear approximations to nonlinear systems) 36

Joint Space versus Task Space Control Task coordinates Reference trajectory Task space control Kinematics 37

Task Space Control Task coordinates Task space control Kinematics Commanded joint accelerations Computed torque control 38