Chapter 08
Chapter 08
About ARAS
ARAS Research group originated in 1997 and is proud of its 22+ years of brilliant background, and its contributions to
the advancement of academic education and research in the field of Dynamical System Analysis and Control in the
robotics application.ARAS are well represented by the industrial engineers, researchers, and scientific figures graduated
from this group, and numerous industrial and R&D projects being conducted in this group. The main asset of our
research group is its human resources devoted all their time and effort to the advancement of science and technology.
One of our main objectives is to use these potentials to extend our educational and industrial collaborations at both
national and international levels. In order to accomplish that, our mission is to enhance the breadth and enrich the
quality of our education and research in a dynamic environment.
Global Observers
3 Nonlinear but known systems, nonlinear Lipschitz systems,
extension of linear observer design.
High-Gain Observer
4
Motivating example; 2nd order system, nonlinear observer,
rejecting uncertainty, peaking phenomenon. Observer
formulation.
In this chapter we review design of observers for nonlinear systems. First a review on linear observer designs are given, and the optimal Kalman
filter formulation is introduce. Then the use of this design for linearized system is given, and it is generalized to extended Kalman filter with
variable observer gain. Then design on nonlinear observer for known and uncertain system is elaborated.
Nonlinear Control K. N. Toosi University of Technology, Faculty of Electrical Engineering,
Prof. Hamid D. Taghirad Department of Systems and Control, Advanced Robotics and Automated Systems October 21, 2020
5
Nonlinear Observers
• Motivation
In many controller designs
• We need state-feedback
– Full state information is needed
– All state measurements are costly
• Could we use output-feedback
– Estimate the states from the outputs
– Observers are dynamical systems to do that
• In linear systems, we have separation theorem
– Design converging observer separately from stabilizing state-
feedback controller
– Stability of the closed loop output-controller is preserved.
Nonlinear Control K. N. Toosi University of Technology, Faculty of Electrical Engineering,
Prof. Hamid D. Taghirad Department of Systems and Control, Advanced Robotics and Automated Systems October 21, 2020
6
Nonlinear Observers
• Motivation
Review observer design in linear systems
𝑥ሶ = 𝐴𝑥 + 𝐵𝑢, 𝑦 = 𝐶𝑥
• Full-state observer:
𝑥ොሶ = 𝐴𝑥ො + 𝐵𝑢 + 𝐻 𝑦 − 𝐶 𝑥ො
– If the pair (𝐴, 𝐶) is detectable
– 𝐻 can be designed such that the estimation error dynamics 𝑥 = 𝑥 − 𝑥ො
is stable
𝑥ሶ = 𝑥ሶ − 𝑥ොሶ = 𝐴 𝑥 − 𝑥ො − 𝐻 𝐶𝑥 − 𝐶 𝑥ො
𝑥ሶ = 𝐴 − 𝐻𝐶 𝑥
– For stability: design 𝐻 ∋ 𝐴 − 𝐻𝐶 is Hurwitz.
• This can be done on pole placement
• Or optimal LQE design
Nonlinear Control K. N. Toosi University of Technology, Faculty of Electrical Engineering,
Prof. Hamid D. Taghirad Department of Systems and Control, Advanced Robotics and Automated Systems October 21, 2020
7
Nonlinear Observers
• Motivation
For nonlinear system
𝑥ሶ = 𝑓(𝑥, 𝑢), 𝑦 = ℎ(𝑥)
• Design full-state observer:
𝑥ොሶ = 𝑓(𝑥,ො 𝑢) + 𝐻 ⋅ 𝑦 − ℎ(𝑥)
ො
– Where 𝐻(⋅) could be a constant or time-varying matrix.
– The term 𝑓(𝑥,
ො 𝑢) comes from model prediction
– The term 𝐻 ⋅ 𝑦 − ℎ(𝑥)
ො is a correcting term from observation model
• Two different approach could be used in observer design
– Linearization based methods
• Local Observers and EKF (both valid near equilibrium point)
– Global model based observers
• Model without uncertainty and with uncertainty
– Where:
• Optimal Observer
Linear-Quadratic Estimator (LQE)
• Consider LQE design for uncertain system
𝑥ሶ = 𝐴𝑥 + 𝐵𝑢 + 𝑤, 𝑦 = 𝐶𝑥 + 𝑣
– In which 𝑤 is the model uncertainty, while 𝑄 = Cov 𝑤 ,
– And 𝑣 denotes the observation noise, while 𝑅 = Cov 𝑣 .
Nonlinear Control K. N. Toosi University of Technology, Faculty of Electrical Engineering,
Prof. Hamid D. Taghirad Department of Systems and Control, Advanced Robotics and Automated Systems October 21, 2020
13
Local Observer
• Full-state LQE observer:
𝑥ොሶ = 𝐴𝑥ො + 𝐵𝑢 + 𝐻 𝑦 − 𝐶 𝑥ො
– LQE optimal Gain:
𝐻 = 𝑃𝐶 𝑇 𝑅−1 (11.6)
– Where 𝑃 satisfies the Riccati Equation:
• Remark:
∞
– The LQE will minimize 𝐽 = 𝐸 0 𝑥 𝑇 𝑡 ⋅ 𝑥 𝑡 𝑑𝑡
– 𝑃 and 𝐻 are constant in this design.
– Stabilizing the estimation error dynamics close to origin.
– See EKF formulation for time-varying optimal gain 𝐻(𝑡).
• where
Global Observers
3 Nonlinear but known systems, nonlinear Lipschitz systems,
extension of linear observer design.
High-Gain Observer
4
Motivating example; 2nd order system, nonlinear observer,
rejecting uncertainty, peaking phenomenon. Observer
formulation.
In this chapter we review design of observers for nonlinear systems. First a review on linear observer designs are given, and the optimal Kalman
filter formulation is introduce. Then the use of this design for linearized system is given, and it is generalized to extended Kalman filter with
variable observer gain. Then design on nonlinear observer for known and uncertain system is elaborated.
Nonlinear Control K. N. Toosi University of Technology, Faculty of Electrical Engineering,
Prof. Hamid D. Taghirad Department of Systems and Control, Advanced Robotics and Automated Systems October 21, 2020
20
Local Observer
• Extended Kalman Filter
Consider
• The nonlinear system (11.1) and the observer (11.2)
• With time-varying observer gain 𝐻(𝑡)
• The estimation error 𝑥 = 𝑥 − 𝑥ො satisfies:
𝑥ሶ = 𝑓 𝑥, 𝑢 − 𝑓(𝑥,
ො 𝑢) + 𝐻(𝑡) ℎ(𝑥) − ℎ(𝑥)
ො (11.8)
• Use Taylor series about 𝑥 =0
– Where
– and
• Sketch of Proof:
– From Assumption 11.1 There exist 𝑃−1 𝑡 ∋ m (11.15)
– Consider Lyapunov candidate: 𝑉 = 𝑥 𝑇 𝑃−1 𝑥
– and note 𝑃ሶ −1 = −𝑃−1 𝑃𝑃
ሶ −1
1
– Where 𝑟 is the positive roots of − 𝑐1 + 𝑐2 𝑘1 + 𝑐2 𝑘2 𝑦 2 .
2
– Hence the origin is exponentially stable. □
• where
Global Observers
3 Nonlinear but known systems, nonlinear Lipschitz systems,
extension of linear observer design.
High-Gain Observer
4
Motivating example; 2nd order system, nonlinear observer,
rejecting uncertainty, peaking phenomenon. Observer
formulation.
In this chapter we review design of observers for nonlinear systems. First a review on linear observer designs are given, and the optimal Kalman
filter formulation is introduce. Then the use of this design for linearized system is given, and it is generalized to extended Kalman filter with
variable observer gain. Then design on nonlinear observer for known and uncertain system is elaborated.
Nonlinear Control K. N. Toosi University of Technology, Faculty of Electrical Engineering,
Prof. Hamid D. Taghirad Department of Systems and Control, Advanced Robotics and Automated Systems October 21, 2020
29
Nonlinear Observers
• Global Observers
Consider a nonlinear but known system
• Consider system in the form:
Global Observers
3 Nonlinear but known systems, nonlinear Lipschitz systems,
extension of linear observer design.
High-Gain Observer
4
Motivating example; 2nd order system, nonlinear observer,
rejecting uncertainty, peaking phenomenon. Observer
formulation.
In this chapter we review design of observers for nonlinear systems. First a review on linear observer designs are given, and the optimal Kalman
filter formulation is introduce. Then the use of this design for linearized system is given, and it is generalized to extended Kalman filter with
variable observer gain. Then design on nonlinear observer for known and uncertain system is elaborated.
Nonlinear Control K. N. Toosi University of Technology, Faculty of Electrical Engineering,
Prof. Hamid D. Taghirad Department of Systems and Control, Advanced Robotics and Automated Systems October 21, 2020
33
Global Observers
• High-Gain Observer
Motivate Example:
• Consider the two-dimensional system:
𝑥ሶ 1 = 𝑥2 , 𝑥ሶ 2 = 𝜙 𝑥, 𝑢 , 𝑦 = 𝑥1
– The nonlinear dynamics 𝜙 is unknown, but its nominal value 𝜙0 is given.
• Consider the observer as:
𝑥ොሶ = 𝑥ො2 + ℎ1 𝑦 − 𝑥ො1 , 𝑥ොሶ = 𝜙0 𝑥,
ො 𝑢 + ℎ2 (𝑦 − 𝑥ො1 )
– Assume that by the choice of 𝜙0 :
𝜙0 𝑧, 𝑢 − 𝜙(𝑥, 𝑢) ≤ 𝐿 𝑥 − 𝑧 + 𝑀
– The estimation error dynamics is:
– and 𝛿 𝑥, 𝑥,
𝑢 = 𝜙 𝑥, 𝑢 − 𝜙0 (𝑥,
ො 𝑢).
Nonlinear Control K. N. Toosi University of Technology, Faculty of Electrical Engineering,
Prof. Hamid D. Taghirad Department of Systems and Control, Advanced Robotics and Automated Systems October 21, 2020
34
High-Gain Observer
Motivate Example:
• This is a perturbation to the linear system.
𝑇
– In the presence of 𝛿, design 𝐻 = ℎ1 , ℎ2 to rejects 𝛿 effect on 𝑥.
• Find transfer matrix from 𝛿 to 𝑥.
𝑇
– Call 𝜂 = 𝜂1 , 𝜂2 the fast states.
– Then
– For 𝜀𝐿 𝑃𝐵 ≤ 1/4:
• where 𝜂 satisfies:
Nonlinear Control K. N. Toosi University of Technology, Faculty of Electrical Engineering,
Prof. Hamid D. Taghirad Department of Systems and Control, Advanced Robotics and Automated Systems October 21, 2020
41
High-Gain Observer
• Observer Formulation:
• Proof: (Cont.)
T
– In which 𝛿 = 𝛿1 , 𝛿2 , … , 𝛿𝜌 ,
– and
– Independent of 𝜀 > 0.
– Let 𝑉 = 𝜂 𝑇 𝑃𝜂, with 𝑃 being the solution of 𝑃𝐹 + 𝐹 𝑇 𝑃 = −𝐼, then
– For
Thank You
Nonlinear Control K. N. Toosi University of Technology, Faculty of Electrical Engineering,
Prof. Hamid D. Taghirad Department of Systems and Control, Advanced Robotics and Automated Systems October 21, 2020
About Hamid D. Taghirad
Hamid D. Taghirad has received his B.Sc. degree in mechanical engineering
from Sharif University of Technology, Tehran, Iran, in 1989, his M.Sc. in mechanical
engineering in 1993, and his Ph.D. in electrical engineering in 1997, both
from McGill University, Montreal, Canada. He is currently the University Vice-
Chancellor for Global strategies and International Affairs, Professor and the Director
of the Advanced Robotics and Automated System (ARAS), Department of Systems
and Control, Faculty of Electrical Engineering, K. N. Toosi University of Technology,
Hamid D. Taghirad Tehran, Iran. He is a senior member of IEEE, and Editorial board of International
Journal of Robotics: Theory and Application, and International Journal of Advanced
Professor Robotic Systems. His research interest is robust and nonlinear control applied to
robotic systems. His publications include five books, and more than 250 papers in
international Journals and conference proceedings.