STATE VARIABLE (SV) SYSTEMS

Similar documents
Time Response of Dynamic Systems! Multi-Dimensional Trajectories Position, velocity, and acceleration are vectors

Manifesto on Numerical Integration of Equations of Motion Using Matlab

System Simulation using Matlab

System simulation using Matlab, state plane plots

1. Linearization of a nonlinear system given in the form of a system of ordinary differential equations

Dynamic Modeling. For the mechanical translational system shown in Figure 1, determine a set of first order

Robotics. Dynamics. Marc Toussaint U Stuttgart

(Refer Slide Time: 00:01:30 min)

Appendix 3B MATLAB Functions for Modeling and Time-domain analysis

Interpolation. Create a program for linear interpolation of a three axis manufacturing machine with a constant

MODERN CONTROL DESIGN

MULTIVARIABLE ZEROS OF STATE-SPACE SYSTEMS

1.4 Unit Step & Unit Impulse Functions

Topic # Feedback Control

Chapter 2 Optimal Control Problem

Analog Signals and Systems and their properties

State Space Representation

ENGG 5402 Course Project: Simulation of PUMA 560 Manipulator

Introduction to Modern Control MT 2016

Modeling and Experimentation: Compound Pendulum

Chapter 1 Fundamental Concepts

Robotics. Dynamics. University of Stuttgart Winter 2018/19

9. Introduction and Chapter Objectives

Linearized Equations of Motion!

TUTORIAL: STATE VARIABLES and MATLAB

Dynamic Modeling of Rotary Double Inverted Pendulum Using Classical Mechanics

Continuous Dynamics Solving LTI state-space equations גרא וייס המחלקה למדעי המחשב אוניברסיטת בן-גוריון

Section 7.4 Runge-Kutta Methods

EE Control Systems LECTURE 9

MAT 275 Laboratory 4 MATLAB solvers for First-Order IVP

ACM/CMS 107 Linear Analysis & Applications Fall 2016 Assignment 4: Linear ODEs and Control Theory Due: 5th December 2016

Control Systems I. Lecture 2: Modeling. Suggested Readings: Åström & Murray Ch. 2-3, Guzzella Ch Emilio Frazzoli

MAT 275 Laboratory 4 MATLAB solvers for First-Order IVP

Fuzzy Based Robust Controller Design for Robotic Two-Link Manipulator

Case Study: The Pelican Prototype Robot

EE C128 / ME C134 Final Exam Fall 2014

AMS 27L LAB #8 Winter 2009

06/12/ rws/jMc- modif SuFY10 (MPF) - Textbook Section IX 1

The dynamics of a Mobile Inverted Pendulum (MIP)

Linearization problem. The simplest example

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

In the presence of viscous damping, a more generalized form of the Lagrange s equation of motion can be written as

Chapter 1 Fundamental Concepts

2.010 Fall 2000 Solution of Homework Assignment 1

CDS 110: Lecture 2-2 Modeling Using Differential Equations

ELEC4631 s Lecture 2: Dynamic Control Systems 7 March Overview of dynamic control systems

ECE557 Systems Control

Lesson 9: Predator-Prey and ode45

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

1. Type your solutions. This homework is mainly a programming assignment.

Consider the following example of a linear system:

Optimal Control. Lecture 18. Hamilton-Jacobi-Bellman Equation, Cont. John T. Wen. March 29, Ref: Bryson & Ho Chapter 4.

The Inverted Pendulum

The Process. 218 Technical Applications of Computers

Lyapunov Stability Analysis: Open Loop

Identification Methods for Structural Systems. Prof. Dr. Eleni Chatzi Lecture March, 2016

Lecture 1: Introduction to System Modeling and Control. Introduction Basic Definitions Different Model Types System Identification

Solution: (a) Before opening the parachute, the differential equation is given by: dv dt. = v. v(0) = 0

Lecture 9. Systems of Two First Order Linear ODEs

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

Stabilization and Passivity-Based Control

Solving systems of ODEs with Matlab

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

Optimal Control. Quadratic Functions. Single variable quadratic function: Multi-variable quadratic function:

446 CHAP. 8 NUMERICAL OPTIMIZATION. Newton's Search for a Minimum of f(x,y) Newton s Method

Math 409/509 (Spring 2011)

FEEDBACK CONTROL SYSTEMS

MAT 275 Laboratory 4 MATLAB solvers for First-Order IVP

Richiami di Controlli Automatici

Numerical Methods for ODEs. Lectures for PSU Summer Programs Xiantao Li

Graded Project #1. Part 1. Explicit Runge Kutta methods. Goals Differential Equations FMN130 Gustaf Söderlind and Carmen Arévalo

AC&ST AUTOMATIC CONTROL AND SYSTEM THEORY SYSTEMS AND MODELS. Claudio Melchiorri

Symmetries 2 - Rotations in Space

= 0 otherwise. Eu(n) = 0 and Eu(n)u(m) = δ n m

t = g = 10 m/s 2 = 2 s T = 2π g

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

An Introduction to Control Systems

Swing-Up Problem of an Inverted Pendulum Energy Space Approach

Physics 235 Chapter 7. Chapter 7 Hamilton's Principle - Lagrangian and Hamiltonian Dynamics

Lecture 9: Eigenvalues and Eigenvectors in Classical Mechanics (See Section 3.12 in Boas)

1. Find the solution of the following uncontrolled linear system. 2 α 1 1

Semester 1 Revision. Last modified: 05/06/2018

University of Alberta ENGM 541: Modeling and Simulation of Engineering Systems Laboratory #5

Intro. Computer Control Systems: F8

Georgia Institute of Technology Nonlinear Controls Theory Primer ME 6402

State Space Control D R. T A R E K A. T U T U N J I

Control Systems I. Lecture 2: Modeling and Linearization. Suggested Readings: Åström & Murray Ch Jacopo Tani

Analytical Mechanics: Variational Principles

Robot Dynamics II: Trajectories & Motion

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

Topic # /31 Feedback Control Systems

Chapter 13 Lecture. Essential University Physics Richard Wolfson 2 nd Edition. Oscillatory Motion Pearson Education, Inc.

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

Lesson 11: Mass-Spring, Resonance and ode45

Chapter 3 Numerical Methods

Lecture 1 From Continuous-Time to Discrete-Time

moments of inertia at the center of gravity (C.G.) of the first and second pendulums are I 1 and I 2, respectively. Fig. 1. Double inverted pendulum T

Comparison of LQR and PD controller for stabilizing Double Inverted Pendulum System

ENGR-1100 Introduction to Engineering Analysis. Lecture 9

1 Overview of Simulink. 2 State-space equations

Transcription:

Copyright F.L. Lewis 999 All rights reserved Updated:Tuesday, August 05, 008 STATE VARIABLE (SV) SYSTEMS A natural description for dynamical systems is the nonlinear state-space or state variable (SV) equation x = f ( () y = h( n m p with x( t) R the internal state, u( t) R the control input, and y( t) R the measured output. These equations are nonlinear and can capture very general system behaviors. The nonlinear state equation follows in a natural manner from a physical analysis of naturally occurring systems, using, for instance, Hamilton's equations of motion or Lagrange's equation of motion d L L = F, dt q q with q (t) the generalized position vector, q (t) the generalized velocity vector, and F(t) the generalized force vector. The Lagrangian is L= K-U, the kinetic energy minus the potential energy. Using Lagrange's equation, one can derive the nonlinear function f(. The output function h( depends on the measurements selected by the design engineer. Note that the SV model has m inputs, n states, and p outputs, so it can represent complicated multivariable (multi-input/multi-output) systems such as modern aerospace systems, automobiles, submarine vehicles, etc. The nonlinear state-space system has the structure shown in the figure. Note that it contains an integrator, which acts as the memory of this dynamical system. u(t) f( dx(t)/dt s x(t) h( y(t) Nonlinear State-Space System

The linear state-space equations are given by x = Ax + Bu y = Cx + Du where A is the system or plant matri B is the control input matri C is the output or measurement matri and D is the direct feed matrix. This description is said to be timeinvariant if A, B, C, D are constant matrices. These equations are obtained directly from a physical analysis if the system is inherently linear. The linear state-space system has the form shown in the figure. It has more structure than the nonlinear SV system. For that reason, control system design is easier for linear SV systems. Note that the feedback is determined only by the system A matrix. The direct feedback matrix D is often equal to zero for many systems. D u(t) B dx(t)/dt s x(t) C y(t) A Linear State-Space System If the system is nonlinear, then the state equations are nonlinear. In this case, an approximate linearized system description may be obtained by computing the Jacobian matrices f f h h A( =, B( =, C( =, D( =. x u x u These are evaluated at a nominal set point ( to obtain constant system matrices A,B,C,D, yielding a linear time-invariant state description which is approximately valid for small excursions about the nominal point. The Jacobian resulting from differentiation of a p-vector function h with respect u = u u is a p m matrix found as u m to an m-vector variable [ ] T h h = u u h u.

Example A second-order differential equation of the sort occurring in robotic systems is mq + mlq + mgl sin q = τ x = x x as where q(t) is an angle and τ(t) is an input torque. By defining the state [ ] T x = q( t), x = q ( t) one may write the state equation x x = x = Lx gl sin x + u m where the control input is u(t)= τ(t). To solve the second-order differential equation one requires two initial conditions, e.g. q( 0), q (0). Thus, there are two state components. The state components correspond to energy storage variables. For instance, in this case one could think of potential energy mgh (the third term in the differential equation, which involves q (t) ), and rotational kinetic energy involves ω = q (t ) ). noting that [ ] T m ω (the second term, which This is a nonlinear state equation. One can place it into the form () simply by x = x x and writing x x f ( x = Lx gl sin x + u m This defines f( as the given nonlinear function -vector. By computing the Jacobians, the linear SV representation is found to be x = 0 x + u = Ax Bu gl x Lx + 0. cos m Evaluating this at a nominal equilibrium point of x=0, u=0 yields the linear time-invariant state description 0 x = x + u = Ax + Bu gl 0 0 m which describes small excursions about the origin. 3

The function f( is given by the dynamics of the system. By contrast, the output function h( is given by which measurements the engineer decides to take. It is easy to measure angles using an optical encoder. However, measuring angular velocities requires a tachometer, which is more expensive. Therefore, suppose we decide to measure the robot joint angle x = q. Then the output function is given as y = h( = [ 0]x. This equation is linear and directly defines the matrices = [ 0], D = 0 C. 4

COMPUTER SIMULATION Given the state-space description it is very easy to simulate a system on a computer. All one requires is a numerical integration routine such as Runge-Kutta that computes the state derivative using x = f ( to determine x(t) over a time interval. MATLAB has an integration routine 'ode3' that can be used to simulate any nonlinear system in state-space form. For linear systems, MATLAB has a variety of simulation routines including 'step' for the step response, etc., however, it is recommended that 'ode3' be used even for linear systems, since it facilitates controller design and simulation. Example To use 'ode3' one must write a function M-file that contains the state equations. To simulate the nonlinear system in Example, one may use the M-file: function xdot= robot(t,x) ; g= 9.8 ; L= ; m= 0 ; u= sin(*pi*t) xdot()= x() ; xdot()= -g*l*sin(x()) - L*x()^ + u/m ; where we have assumed that L= m, m= 0 Kg. The control input is set to be a sinusoid. Using vector operations one could write the simpler M-file: function xdot= robot(t,x) ; g= 9.8 ; L= ; m= 0 ; u= sin(*pi*t) xdot= [x() ; -g*l*sin(x()) - L*x()^ + u/m] ; Note that the semicolon is used to terminate each line to avoid printing to the screen during computations. Given this M-file, stored in a file named 'robot.m', let's say, the following command lines compute and plot the time response over the time interval 0 to 0 sec: tint= [0 0] ; % define time interval [t0 tf] x0= [0 0.]' ; % initial conditions [t,x]= ode3('robot', tint, x0); plot(t,x) Using this code, one obtains the figure shown. 5

0.5 0. 0.05 0-0.05-0. -0.5-0. 0 4 6 8 0 4 6 8 0 Time plot of x(), x() vs. time A Phase-Plane plot is a graph of x() vs. x(). To make this plot, one uses plot(x(:,),x(:,)) and obtains the figure shown. Note the use of the colon to select an entire column in an array. 0.5 0. 0.05 0-0.05-0. -0.5-0. -0.05-0.04-0.03-0.0-0.0 0 0.0 0.0 0.03 0.04 0.05 Phase-plane plot of x() vs. x() In which direction does the plot move- clockwise or counterclockwise? 6

Using MATLAB, one is able to perform very quickly the most exotic of analysis, simulation, and plotting tasks. An introduction to MATLAB and some excellent demos are available at the MATLAB website www.mathworks.com. The next two samples are taken from Shahian and Hassul, "Control System Design Using MATLAB," Prentice- Hall, 993. 7

8