LQR, Kalman Filter, and LQG. Postgraduate Course, M.Sc. Electrical Engineering Department College of Engineering University of Salahaddin

Similar documents
Here represents the impulse (or delta) function. is an diagonal matrix of intensities, and is an diagonal matrix of intensities.

Chapter 3. LQ, LQG and Control System Design. Dutch Institute of Systems and Control

Robust Control 5 Nominal Controller Design Continued

EL2520 Control Theory and Practice

Lecture 2: Discrete-time Linear Quadratic Optimal Control

Lecture 10 Linear Quadratic Stochastic Control with Partial State Observation

OPTIMAL CONTROL AND ESTIMATION

Lecture 9. Introduction to Kalman Filtering. Linear Quadratic Gaussian Control (LQG) G. Hovland 2004

6.241 Dynamic Systems and Control

5. Observer-based Controller Design

Contents. 1 State-Space Linear Systems 5. 2 Linearization Causality, Time Invariance, and Linearity 31

Time-Invariant Linear Quadratic Regulators Robert Stengel Optimal Control and Estimation MAE 546 Princeton University, 2015

Linear-Quadratic-Gaussian (LQG) Controllers and Kalman Filters

Steady State Kalman Filter

Semidefinite Programming Duality and Linear Time-invariant Systems

6 OUTPUT FEEDBACK DESIGN

Linear System Theory

Subject: Optimal Control Assignment-1 (Related to Lecture notes 1-10)

Lecture 7 LQG Design. Linear Quadratic Gaussian regulator Control-estimation duality SRL for optimal estimator Example of LQG design for MIMO plant

MATH4406 (Control Theory) Unit 6: The Linear Quadratic Regulator (LQR) and Model Predictive Control (MPC) Prepared by Yoni Nazarathy, Artem

6. Linear Quadratic Regulator Control

Time-Invariant Linear Quadratic Regulators!

OPTIMAL CONTROL SYSTEMS

Linear Quadratic Gausssian Control Design with Loop Transfer Recovery

16.31 Fall 2005 Lecture Presentation Mon 31-Oct-05 ver 1.1

Exam. 135 minutes, 15 minutes reading time

EE C128 / ME C134 Final Exam Fall 2014

Lecture 1: Pragmatic Introduction to Stochastic Differential Equations

Chapter 9 Observers, Model-based Controllers 9. Introduction In here we deal with the general case where only a subset of the states, or linear combin

I. D. Landau, A. Karimi: A Course on Adaptive Control Adaptive Control. Part 9: Adaptive Control with Multiple Models and Switching

Final Exam Solutions

Autonomous Mobile Robot Design

ECE7850 Lecture 7. Discrete Time Optimal Control and Dynamic Programming

Module 07 Controllability and Controller Design of Dynamical LTI Systems

Linear-Quadratic-Gaussian Controllers!

EL 625 Lecture 10. Pole Placement and Observer Design. ẋ = Ax (1)

State Observers and the Kalman filter

State Regulator. Advanced Control. design of controllers using pole placement and LQ design rules

CALIFORNIA INSTITUTE OF TECHNOLOGY Control and Dynamical Systems. CDS 110b

Probability and Statistics for Final Year Engineering Students

Communication Theory II

Quadratic Stability of Dynamical Systems. Raktim Bhattacharya Aerospace Engineering, Texas A&M University

Lecture 4 Continuous time linear quadratic regulator

Massachusetts Institute of Technology

ELEG 3143 Probability & Stochastic Process Ch. 6 Stochastic Process

OPTIMAL CONTROL. Sadegh Bolouki. Lecture slides for ECE 515. University of Illinois, Urbana-Champaign. Fall S. Bolouki (UIUC) 1 / 28

EE221A Linear System Theory Final Exam

Lecture 2 and 3: Controllability of DT-LTI systems

Homework Solution # 3

Suppose that we have a specific single stage dynamic system governed by the following equation:

EE363 homework 7 solutions

Control Design. Lecture 9: State Feedback and Observers. Two Classes of Control Problems. State Feedback: Problem Formulation

Optimal Polynomial Control for Discrete-Time Systems

SRI VIDYA COLLEGE OF ENGINEERING AND TECHNOLOGY UNIT 3 RANDOM PROCESS TWO MARK QUESTIONS

Feedback Control of Turbulent Wall Flows

Linear Quadratic Regulator (LQR) Design II

Probabilistic Graphical Models

Return Difference Function and Closed-Loop Roots Single-Input/Single-Output Control Systems

Linear Quadratic Regulator (LQR) Design I

Topic # Feedback Control Systems

Chapter 6. Random Processes

AA/EE/ME 548: Problem Session Notes #5

9 Controller Discretization

Course Outline. Higher Order Poles: Example. Higher Order Poles. Amme 3500 : System Dynamics & Control. State Space Design. 1 G(s) = s(s + 2)(s +10)

EAS 305 Random Processes Viewgraph 1 of 10. Random Processes

MODERN CONTROL DESIGN

1 Continuous-time Systems

4F3 - Predictive Control

Lecture 7 : Generalized Plant and LFT form Dr.-Ing. Sudchai Boonto Assistant Professor

CALIFORNIA INSTITUTE OF TECHNOLOGY Control and Dynamical Systems. CDS 110b

H 2 Optimal State Feedback Control Synthesis. Raktim Bhattacharya Aerospace Engineering, Texas A&M University

Stochastic Optimal Control!

Control Systems I. Lecture 4: Diagonalization, Modal Analysis, Intro to Feedback. Readings: Emilio Frazzoli

Extensions and applications of LQ

Nonlinear Observers. Jaime A. Moreno. Eléctrica y Computación Instituto de Ingeniería Universidad Nacional Autónoma de México

EECS C128/ ME C134 Final Wed. Dec. 14, am. Closed book. One page, 2 sides of formula sheets. No calculators.

Modern Optimal Control

State Space Representation of Gaussian Processes

EE Control Systems LECTURE 9

Statistical Techniques in Robotics (16-831, F12) Lecture#17 (Wednesday October 31) Kalman Filters. Lecturer: Drew Bagnell Scribe:Greydon Foil 1

Module 02 CPS Background: Linear Systems Preliminaries

Denis ARZELIER arzelier

P 1.5 X 4.5 / X 2 and (iii) The smallest value of n for

PROBABILITY AND RANDOM PROCESSESS

Problem 1 Cost of an Infinite Horizon LQR

Lecture 5 Linear Quadratic Stochastic Control

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

Name of the Student: Problems on Discrete & Continuous R.Vs

ECE 636: Systems identification

Lecture 5: Linear Systems. Transfer functions. Frequency Domain Analysis. Basic Control Design.

Stochastic Processes. M. Sami Fadali Professor of Electrical Engineering University of Nevada, Reno

Optimal control and estimation

Control Systems I. Lecture 5: Transfer Functions. Readings: Emilio Frazzoli. Institute for Dynamic Systems and Control D-MAVT ETH Zürich

LINEAR QUADRATIC GAUSSIAN

SUCCESSIVE POLE SHIFTING USING SAMPLED-DATA LQ REGULATORS. Sigeru Omatu

L2 gains and system approximation quality 1

POLE PLACEMENT. Sadegh Bolouki. Lecture slides for ECE 515. University of Illinois, Urbana-Champaign. Fall S. Bolouki (UIUC) 1 / 19

Lecture 4: Extended Kalman filter and Statistically Linearized Filter

Frequency methods for the analysis of feedback systems. Lecture 6. Loop analysis of feedback systems. Nyquist approach to study stability

Modeling and Analysis of Dynamic Systems

Transcription:

LQR, Kalman Filter, and LQG Postgraduate Course, M.Sc. Electrical Engineering Department College of Engineering University of Salahaddin May 2015

Linear Quadratic Regulator (LQR) Consider a linear system characterized by x = Ax + Bu where (A, B) is stabilizable. We define the cost index as and (A, Q 1/2 ) is detectable. The linear quadratic regulation problem is to find a control law u(t) = Fx(t) such that (A BF) is stable and J is minimized. The solution is given by: F = R 1 B T P with PA + A T P PBR 1 B T P + Q = 0 If wearrange the LQR control in the following block diagram: We can find its gain margin and phase margin as wehave done in classical control. It is clear that : Open loop transfer function = F(sI A) 1 B = R 1 B T P(sI A) 1 B The block diagram can be re-drawn as: Robust Control EED at University of Salahaddin 2 of 20

LQR: Return Difference Equality and Inequality Consider the LQR control law. The following so-called return difference equality hold: The following is called the return difference inequality: Robust Control EED at University of Salahaddin 3 of 20

LQR: Single Input Case In the single input case, the transfer function Open loop transfer function = f(si A) 1 b is a scalar function. Let Q = hh T, then, the return difference equation is reduced to Robust Control EED at University of Salahaddin 4 of 20

LQR: Single Input Case Cont d Graphically, implies that Robust Control EED at University of Salahaddin 5 of 20

LQR: Example Consider a given plant characterized by 0 1 x = 1 1 x + 0 1 u Solving the LQR problem which minimizes the following cost function: we obtain, which results the closed-loop eigenvalues at 1. 1867± j1. 3814. Clearly, the closed-loop system is asymptotically stable. Robust Control EED at University of Salahaddin 6 of 20

LQR: Example Cont d Robust Control EED at University of Salahaddin 7 of 20

White Noise, Color Noise, and Gaussian Random Process Let f (x,t) be the probability density function (p.d.f.) associated with a random process X(t). If the p.d.f. is independent of time t, i.e., f (x,t) = f (x), then the corresponding random process is said to be stationary. For this type of random processes, wedefine: 1) Mean ( Exception):- m = E X = x. f x dx 2) Moment (j th order moment):- E X j = x j. f x dx 3) Variance :- σ 2 = E (x m) 2 = (x m) 2. f x dx 4) Covariance of two random process:- con(v, w) = E (v E v )(w E w ) Two random processes v and w are said to be independent if E vw = vw f v, w dvdw = 0 where f v, w is the joint point p.d.f of v and w. Autocorrelation function: is used to describe the time domain property of random process. Given a random process v, its autocorrelation function is defined as R x t 1, t 2 = E v t 1 v t 2 and when v is stationary R x t 1, t 2 = R x t 1 t 2 = R x τ = R x t, t + τ = E v t v t + τ Robust Control EED at University of Salahaddin 8 of 20

White Noise, Color Noise, and Gaussian Random Process Cont d Power spectrum of a random process: is the Fourier transform of its autocorrelation function:- S x w = 1 R 2πj x τ e jωt dτ White Noise: is a random process with a constant power spectrum, and an autocorrelation function: R x τ = q. δ(τ) which implies that a white noise has an infinite power and thus it is non existent in our real life. However, many noises (or the so-called color noises, or noises with finite energy and finite frequency components) can be modeled as the outputs of linear systems with an injection of white noise into their inputs, i.e., any color noise can be generated by a white noise Gaussian Process v, is also known as normal process has a p.d.f. f v = 1 σ 2π (v μ)2 e 2σ 2 where µ = mean, 2 = variance Robust Control EED at University of Salahaddin 9 of 20

Kalman Filter for a LTI System Consider a LTI system characterized by x = Ax + Bu + v t y = Cx + w t v is the input noise w is the measurement noise Assume: 1) (A, C) is observable 2) v(t) and w(t) are independent white noise with the following properties E v t = 0, E w t = 0 E v t v T (τ) = Qδ t τ, E w t w T (τ) = Rδ t τ, Q = Q T 0 R = R T > 0 3) (A, Q 1/2 ) is stabilizable ( to guarantee closed-loop stability) The problem of Kalman Filter is to design a state estimator to estimate the state x(t) by x t such that the estimation error covariance is minimized, i.e., the following index is minimized Robust Control EED at University of Salahaddin 10 of 20

Construction of Steady State Kalman Filter Kalman filter is a state observe with a specially selected observer gain (or Kalman filter gain). It has the dynamic equation: with the Kalman filter K e being given as where P e is the positive definite solution of the following Riccati equation, Let e = x x, therefore, the Kalman filter has the following properties: Robust Control EED at University of Salahaddin 11 of 20

The Duality of Kalman Filter and Linear Quadratic Regulator (LQR) Recall the optimal regulator problem: The LQR problem is to find a state feedback law u = Fx such that J is minimized. The solution to the above problem is given by: F = R 1 B T P with PA + A T P PBR 1 B T P + Q = 0, P = P T > 0 and the optimal value of J is given by J = x T 0 Px 0. Note that x o is arbitrary. Let consider a special case when x o is a random vector with: E x 0 = 0, E x 0 x T 0 = I Then, Robust Control EED at University of Salahaddin 12 of 20

The Duality of Kalman Filter and Linear Quadratic Regulator (LQR) Cont d Robust Control EED at University of Salahaddin 13 of 20

Linear Quadratic Gaussian (LQG): Problem Statement It is very often in control system design for a real life problem that one cannot measure all the state variables of the given plant. Thus, the linear quadratic regulator, although it has a very impressive gain and phase margins (GM = and PM = 60 degrees), is impractical as it utilizes all state variables in the feedback, i.e., u = F x. In most of practical situations, only partial information of the state of the given plant is accessible or can be measured for feedback. The natural questions one would ask: Can we recover or estimate the state variables of the plant through the partially measurable information? The answer is yes. The solution is Kalman filter. Can we replace x the control law in LQR, i.e., u = F x, by the estimated state to carry out a meaningful control system design? The answer is yes. The solution is called LQG. Do we still have impressive properties associated with LQG? The answer is no. Any solution? Yes. It is called loop transfer recovery (LTR) technique. Robust Control EED at University of Salahaddin 14 of 20

Linear Quadratic Gaussian (LQG): Design Consider a given plant characterized by x = Ax + Bu + v t y = Cx + w t v is the input noise w is the measurement noise where v(t) and w(t) are the white with zero means. v(t), w(t), x(o) are independent, and The performance index has to be modified as follows: The Linear Quadratic Gaussian (LQG) control is to design a control law that only requires the measurable information such that when it is applied to the given plant, the overall system is stable and the performance index is minimized. Robust Control EED at University of Salahaddin 15 of 20

Solution to the LQG Problem Separation Principle Step 1: Design an LQR control law u = Fx which solves the following problem: Step 2: Design a Kalman filter for the given, i.e. Step 3: The LQG control law is given by u = F x, i.e. Robust Control EED at University of Salahaddin 16 of 20

Block Diagram Implementation of LQG Control Law Robust Control EED at University of Salahaddin 17 of 20

Closed-Loop Dynamics of the Given Plant together with LQG Controller Recall the plant and the controller We define a new variable e = x x and thus and Clearly, the closed-loop system is characterized by the following state space equation, The closed-loop poles are given by λ A BF λ A K e C, which are stable. Robust Control EED at University of Salahaddin 18 of 20

LQG Controller Robustly Is an LQG Controller Robust? It is now well-known that the linear quadratic regulator (LQR) has very impressive robustness properties, including guaranteed infinite gain margins and 60 degrees phase margins in all channels. The result is only valid, however, for the full state feedback case. If observers or Kalman filters (i.e., LQG regulators ) are used in implementation, no guaranteed robustness properties hold. Still worse, the closed-loop system may become unstable if you do not design the observer of Kalman filter properly. Robust Control EED at University of Salahaddin 19 of 20

End of Lecture 8! Robust Control EED at University of Salahaddin 20 of 20