The document introduces deterministic and stochastic observers. Deterministic observers estimate states using a model and measurements, like the Luenberger observer. Stochastic observers, like the Kalman filter, also account for noise. The document discusses open-loop and closed-loop observer designs, how to select observer eigenvalues, and approaches for partial state estimation.
G. Antonelli and F. Arrichiello and F. Caccavale and A. Marino, A decentralized controller-observer scheme for weighted centroid tracking, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems, San Franscisco, CA, pp. 2778--2783, 2011.
G. Antonelli and F. Arrichiello and F. Caccavale and A. Marino, A decentralized controller-observer scheme for weighted centroid tracking, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems, San Franscisco, CA, pp. 2778--2783, 2011.
Lesson 14: Derivatives of Exponential and Logarithmic Functions (Section 041 ...Matthew Leingang
The exponential function is pretty much the only function whose derivative is itself. The derivative of the natural logarithm function is also beautiful as it fills in an important gap. Finally, the technique of logarithmic differentiation allows us to find derivatives without the product rule.
F. Arrichiello and G. Antonelli and A.P. Aguiar and A. Pascoal, Observability metrics for the relative localization of AUVs based on range and depth measurements: theory and experiments, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems, San Franscisco, CA, pp. 3166--3171, 2011.
It is a new theory based on an algorithmic approach. Its only element
is called nokton. These rules are precise. The innities are completely
absent whatever the system studied. It is a theory with discrete space
and time. The theory is only at these beginnings.
On Convergence of Jungck Type Iteration for Certain Contractive Conditionsresearchinventy
In this article we prove the strong convergence result for a pair of nonself mappings using Jungck S- iterative scheme in Convex metric spaces satisfying certain contractive condition. The results are the generalization of some existing results in the literature
Fuzzy Speed Regulator for Induction Motor Direct Torque Control SchemeIDES Editor
This paper presents a novel design of a control
scheme for induction motor as a fuzzy logic application,
incorporating fuzzy control technique with direct torque
control method for induction motor drives. The direct torque
control method has been optimized by using fuzzy logic
controller instead of a conventional PI controller in the speed
regulation loop of induction motor drive system. The
presented fuzzy based control scheme combines the benefits of
fuzzy logic control technique along with direct torque control
technique. Compared to the conventional PI regulator, the
high quality speed regulation of induction motor can be
achieved by implementing a fuzzy logic controller as a PI-type
fuzzy speed regulator which is designed based on the
knowledge of experts without using the mathematical model.
The stability of the induction motor drive during transient
and steady operations is assured through the application of
fuzzy speed regulator along with the direct torque control.
The proposed fuzzy speed regulated direct torque control of
induction motor drive system has been validated by using
MATLAB simulink.
Recently, there has been a surge in activity at the interface of optimal transport and statistics (with special emphasis on machine learning applications). The talk will summarize new results and challenges in this active area. For example, we will show how many of the most popular estimators in machine learning (such as Lasso and svm's) can be interpreted as games. This interpretation opens the door for new and potentially better estimators and algorithms, as well as questions about the underlying complexity of these new class of estimators.
(This talk is based on joint work with F. He, Y. Kang, K. Murthy, and F. Zhang)
Lesson 15: Exponential Growth and Decay (Section 041 slides)Matthew Leingang
Many problems in nature are expressible in terms of a certain differential equation that has a solution in terms of exponential functions. We look at the equation in general and some fun applications, including radioactivity, cooling, and interest.
La introducción de la incertidumbre en modelos epidemiológicos es un área de incipiente actividad en la actualidad. En la mayor parte de los enfoques adoptados se asume un comportamiento gaussiano en la formulación de dichos modelos a través de la perturbación de los parámetros vía el proceso de Wiener o movimiento browiniano u otro proceso discretizado equivalente.
En esta conferencia se expone un método alternativo de introducir la incertidumbre en modelos de tipo epidemiológico que permite considerar patrones no necesariamente normales o gaussianos. Con el enfoque adoptado se determinará en contextos epidemiológicos que tienen un gran número de aplicaciones, la primera función de densidad de probabilidad del proceso estocástico solución. Esto permite la determinación exacta de la respuesta media y su variabilidad, así como la construcción de predicciones probabilísticas con intervalos de confianza sin necesidad de recurrir a aproximaciones asintóticas, a veces de difícil legitimación. El enfoque adoptado también permite determinar la distribución probabilística de parámetros que tienen gran importancia para los epidemiólogos, incluyendo la distribución del tiempo hasta que un cierto número de infectados permanecen en la población, lo cual, por ejemplo, permite tener información probabilística para declarar el estado de epidemia o pandemia de una determinada enfermedad. Finalmente, se expondrá algunos de los retos computacionales inmediatos a los que se enfrenta la técnica expuesta.
In this paper, a decentralized control strategy for networked multi-robot systems that allows the tracking of the team centroid and the relative formation is presented. The proposed solution consists of a distributed observer-controller scheme where, based only on local information, each robot
estimates the collective state and tracks the two assigned control variables. We provide a formal stability analysis of the observer-controller scheme and we
relate convergence properties to the topology of the connectivity graph. Experiments are presented to validate the approach.
Lesson 14: Derivatives of Exponential and Logarithmic Functions (Section 041 ...Matthew Leingang
The exponential function is pretty much the only function whose derivative is itself. The derivative of the natural logarithm function is also beautiful as it fills in an important gap. Finally, the technique of logarithmic differentiation allows us to find derivatives without the product rule.
F. Arrichiello and G. Antonelli and A.P. Aguiar and A. Pascoal, Observability metrics for the relative localization of AUVs based on range and depth measurements: theory and experiments, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems, San Franscisco, CA, pp. 3166--3171, 2011.
It is a new theory based on an algorithmic approach. Its only element
is called nokton. These rules are precise. The innities are completely
absent whatever the system studied. It is a theory with discrete space
and time. The theory is only at these beginnings.
On Convergence of Jungck Type Iteration for Certain Contractive Conditionsresearchinventy
In this article we prove the strong convergence result for a pair of nonself mappings using Jungck S- iterative scheme in Convex metric spaces satisfying certain contractive condition. The results are the generalization of some existing results in the literature
Fuzzy Speed Regulator for Induction Motor Direct Torque Control SchemeIDES Editor
This paper presents a novel design of a control
scheme for induction motor as a fuzzy logic application,
incorporating fuzzy control technique with direct torque
control method for induction motor drives. The direct torque
control method has been optimized by using fuzzy logic
controller instead of a conventional PI controller in the speed
regulation loop of induction motor drive system. The
presented fuzzy based control scheme combines the benefits of
fuzzy logic control technique along with direct torque control
technique. Compared to the conventional PI regulator, the
high quality speed regulation of induction motor can be
achieved by implementing a fuzzy logic controller as a PI-type
fuzzy speed regulator which is designed based on the
knowledge of experts without using the mathematical model.
The stability of the induction motor drive during transient
and steady operations is assured through the application of
fuzzy speed regulator along with the direct torque control.
The proposed fuzzy speed regulated direct torque control of
induction motor drive system has been validated by using
MATLAB simulink.
Recently, there has been a surge in activity at the interface of optimal transport and statistics (with special emphasis on machine learning applications). The talk will summarize new results and challenges in this active area. For example, we will show how many of the most popular estimators in machine learning (such as Lasso and svm's) can be interpreted as games. This interpretation opens the door for new and potentially better estimators and algorithms, as well as questions about the underlying complexity of these new class of estimators.
(This talk is based on joint work with F. He, Y. Kang, K. Murthy, and F. Zhang)
Lesson 15: Exponential Growth and Decay (Section 041 slides)Matthew Leingang
Many problems in nature are expressible in terms of a certain differential equation that has a solution in terms of exponential functions. We look at the equation in general and some fun applications, including radioactivity, cooling, and interest.
La introducción de la incertidumbre en modelos epidemiológicos es un área de incipiente actividad en la actualidad. En la mayor parte de los enfoques adoptados se asume un comportamiento gaussiano en la formulación de dichos modelos a través de la perturbación de los parámetros vía el proceso de Wiener o movimiento browiniano u otro proceso discretizado equivalente.
En esta conferencia se expone un método alternativo de introducir la incertidumbre en modelos de tipo epidemiológico que permite considerar patrones no necesariamente normales o gaussianos. Con el enfoque adoptado se determinará en contextos epidemiológicos que tienen un gran número de aplicaciones, la primera función de densidad de probabilidad del proceso estocástico solución. Esto permite la determinación exacta de la respuesta media y su variabilidad, así como la construcción de predicciones probabilísticas con intervalos de confianza sin necesidad de recurrir a aproximaciones asintóticas, a veces de difícil legitimación. El enfoque adoptado también permite determinar la distribución probabilística de parámetros que tienen gran importancia para los epidemiólogos, incluyendo la distribución del tiempo hasta que un cierto número de infectados permanecen en la población, lo cual, por ejemplo, permite tener información probabilística para declarar el estado de epidemia o pandemia de una determinada enfermedad. Finalmente, se expondrá algunos de los retos computacionales inmediatos a los que se enfrenta la técnica expuesta.
In this paper, a decentralized control strategy for networked multi-robot systems that allows the tracking of the team centroid and the relative formation is presented. The proposed solution consists of a distributed observer-controller scheme where, based only on local information, each robot
estimates the collective state and tracks the two assigned control variables. We provide a formal stability analysis of the observer-controller scheme and we
relate convergence properties to the topology of the connectivity graph. Experiments are presented to validate the approach.
G. Antonelli and S. Chiaverini and A. Marino, A coordination strategy for multi-robot sampling of dynamic fields, Proceedings 2012 IEEE International Conference on Robotics and Automation, St Paul, MN, pp. 1113--1118, 2012.
A. Marino and G. Antonelli and A.P. Aguiar and A. Pascoal, Multi-robot harbor patrolling: a probabilistic approach, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems, Algarve, PT, pp. , 2012.
Inverse kinematics is an active research domain in robotics since several years due to its importance in several robotics application. Among the various approaches, differential inverse kinematics is widely used due to the possibility to real-time implementation. Redundant robotic systems exhibit more degrees of freedom than those strictly required to execute a given end-effector task, in such a case, multiple tasks can be handled simultaneously in, e.g., a task-priority architecture. This paper addresses the systematic extension of the multiple tasks singularity robust solution, also known as Null-space Based Behavioral control, to the case of set-based control tasks, i.e., tasks for which a range, rather than a specific value, is assigned. This is the case for several tasks such as, for example, mechanical joint limits of robotic arm as well as obstacle avoidance for any kind of robots. Numerical validation are provided to support the solution proposed.
Coverage of a given area by means of coordinated autonomous robots is a mission
required in several applications such as, for example, patrolling, monitoring or
environmental sampling. From a mathematical perspective, this can often be
modeled as the need to estimate a scalar field, eventually time varying as in
the security applications. In this paper, the problem is addressed for the
challenging underwater scenario, where localization and communication pose
additional constraints. The solution exploits the appealing properties of the
Voronoi partition of a convex set within a probabilistic framework. In addition,
the algorithm is totally distributed and characterized by a strong engineering
perspective allowing the handling of asynchronous communication or possible loss
or adjunct of vehicles. Beyond the test in dozen of numerical case studies, the
algorithm has been validated by a challenging underwater test in 3 dimension
involving two Autonomous Underwater Vehicles (AUVs). The experiments were run in
the La Spezia harbor, in Italy, in February 2012 as demo
of the European project \co3auvs.
The paper presents an adaptive trajectory tracking control strategy for quadrotor Micro Aerial Vehicles. The proposed approach, while keeping the typical assumption of an orientation dynamics faster than the translational one, removes that of absence of external disturbances and of perfect symmetry of the vehicle. In particular, the trajectory tracking control law is made adaptive with respect to the presence of external forces and moments, and to the uncertainty of dynamic parameters as the position of the center of mass of the vehicle. A stability analysis as well as numerical simulations are provided to support the control design.
Professor Timoteo Carletti presented a seminar titled "A journey in the zoo of Turing patterns: the topology does matter as part of the SMART Seminar Series on 8th March 2018.
More information: http://www.uoweis.co/event/a-journey-in-the-zoo-of-turing-patterns-the-topology-does-matter/
Keep updated with future events: http://www.uoweis.co/events/category/smart-infrastructure-facility/
In these two lectures, we’re looking at basic discrete time representations of linear, time invariant plants and models and seeing how their parameters can be estimated using the normal equations.
The key example is the first order, linear, stable RC electrical circuit which we met last week, and which has an exponential response.
International Journal of Mathematics and Statistics Invention (IJMSI) is an international journal intended for professionals and researchers in all fields of computer science and electronics. IJMSI publishes research articles and reviews within the whole field Mathematics and Statistics, new teaching methods, assessment, validation and the impact of new technologies and it will continue to provide information on the latest trends and developments in this ever-expanding subject. The publications of papers are selected through double peer reviewed to ensure originality, relevance, and readability. The articles published in our journal can be accessed online.
Common Fixed Theorems Using Random Implicit Iterative Schemesinventy
Research Inventy : International Journal of Engineering and Science is published by the group of young academic and industrial researchers with 12 Issues per year. It is an online as well as print version open access journal that provides rapid publication (monthly) of articles in all areas of the subject such as: civil, mechanical, chemical, electronic and computer engineering as well as production and information technology. The Journal welcomes the submission of manuscripts that meet the general criteria of significance and scientific excellence. Papers will be published by rapid process within 20 days after acceptance and peer review process takes only 7 days. All articles published in Research Inventy will be peer-reviewed.
Honest Reviews of Tim Han LMA Course Program.pptxtimhan337
Personal development courses are widely available today, with each one promising life-changing outcomes. Tim Han’s Life Mastery Achievers (LMA) Course has drawn a lot of interest. In addition to offering my frank assessment of Success Insider’s LMA Course, this piece examines the course’s effects via a variety of Tim Han LMA course reviews and Success Insider comments.
Introduction to AI for Nonprofits with Tapp NetworkTechSoup
Dive into the world of AI! Experts Jon Hill and Tareq Monaur will guide you through AI's role in enhancing nonprofit websites and basic marketing strategies, making it easy to understand and apply.
Welcome to TechSoup New Member Orientation and Q&A (May 2024).pdfTechSoup
In this webinar you will learn how your organization can access TechSoup's wide variety of product discount and donation programs. From hardware to software, we'll give you a tour of the tools available to help your nonprofit with productivity, collaboration, financial management, donor tracking, security, and more.
The French Revolution, which began in 1789, was a period of radical social and political upheaval in France. It marked the decline of absolute monarchies, the rise of secular and democratic republics, and the eventual rise of Napoleon Bonaparte. This revolutionary period is crucial in understanding the transition from feudalism to modernity in Europe.
For more information, visit-www.vavaclasses.com
Biological screening of herbal drugs: Introduction and Need for
Phyto-Pharmacological Screening, New Strategies for evaluating
Natural Products, In vitro evaluation techniques for Antioxidants, Antimicrobial and Anticancer drugs. In vivo evaluation techniques
for Anti-inflammatory, Antiulcer, Anticancer, Wound healing, Antidiabetic, Hepatoprotective, Cardio protective, Diuretics and
Antifertility, Toxicity studies as per OECD guidelines
Synthetic Fiber Construction in lab .pptxPavel ( NSTU)
Synthetic fiber production is a fascinating and complex field that blends chemistry, engineering, and environmental science. By understanding these aspects, students can gain a comprehensive view of synthetic fiber production, its impact on society and the environment, and the potential for future innovations. Synthetic fibers play a crucial role in modern society, impacting various aspects of daily life, industry, and the environment. ynthetic fibers are integral to modern life, offering a range of benefits from cost-effectiveness and versatility to innovative applications and performance characteristics. While they pose environmental challenges, ongoing research and development aim to create more sustainable and eco-friendly alternatives. Understanding the importance of synthetic fibers helps in appreciating their role in the economy, industry, and daily life, while also emphasizing the need for sustainable practices and innovation.
2024.06.01 Introducing a competency framework for languag learning materials ...Sandy Millin
http://sandymillin.wordpress.com/iateflwebinar2024
Published classroom materials form the basis of syllabuses, drive teacher professional development, and have a potentially huge influence on learners, teachers and education systems. All teachers also create their own materials, whether a few sentences on a blackboard, a highly-structured fully-realised online course, or anything in between. Despite this, the knowledge and skills needed to create effective language learning materials are rarely part of teacher training, and are mostly learnt by trial and error.
Knowledge and skills frameworks, generally called competency frameworks, for ELT teachers, trainers and managers have existed for a few years now. However, until I created one for my MA dissertation, there wasn’t one drawing together what we need to know and do to be able to effectively produce language learning materials.
This webinar will introduce you to my framework, highlighting the key competencies I identified from my research. It will also show how anybody involved in language teaching (any language, not just English!), teacher training, managing schools or developing language learning materials can benefit from using the framework.
Read| The latest issue of The Challenger is here! We are thrilled to announce that our school paper has qualified for the NATIONAL SCHOOLS PRESS CONFERENCE (NSPC) 2024. Thank you for your unwavering support and trust. Dive into the stories that made us stand out!
Digital Tools and AI for Teaching Learning and Research
State estimate
1. introduction
deterministic observer
stochastic observer
A short introduction to
State Estimate
Gianluca Antonelli
Universit` degli Studi di Cassino e del Lazio Meridionale
a
antonelli@unicas.it
http://webuser.unicas.it/lai/robotica
http://www.eng.docente.unicas.it/gianluca antonelli
Gianluca Antonelli Evry, 27-29 march 2013
2. introduction
deterministic observer
stochastic observer
Outline
Introduction
A naive (i.e., open loop) solution
The deterministic case (Luenberger)
The stochastic case (Kalman)
Gianluca Antonelli Evry, 27-29 march 2013
3. introduction
deterministic observer
stochastic observer
Applications
Estimate of vel/acc measuring the position
Estimate of pos/acc measuring the velocity
Inertial Navigation Systems
Feature traking by vision systems
Localization
Mapping
Simoultaneous localization and mapping
Estimate of the battery charging
Econometry
Tracking by radar
Missile pointing
Insuline-glucose control
Global Positioning System
...
Gianluca Antonelli Evry, 27-29 march 2013
4. introduction
deterministic observer
stochastic observer
Modeling
We will deal with ISO (Input State Output) dynamic system described
by differential or difference equations
continuos time discrete time
˙
x(t) = f (x(t), u(t), t) x(k + 1) = f (x(k), u(k), k)
y(t) = h(x(t), t) y(k) = h(x(k), k)
x ∈ Rn , u ∈ Rp , y ∈ Rm
assuming linearity and time invariance
c.t. d.t.
˙
x(t) = Ax(t) + Bu(t) x(k + 1) = Ax(k) + Bu(k)
y(t) = Cx(t) + Du(t) y(k) = Cx(k) + Du(k)
Gianluca Antonelli Evry, 27-29 march 2013
5. introduction
deterministic observer
stochastic observer
Introduction
Measurements give an incomplete view of the state
The filter is required to estimate the state based on the model
knowledge
state measures filter
Gianluca Antonelli Evry, 27-29 march 2013
6. introduction
deterministic observer
stochastic observer
Introduction
Is it possible to estimate the state of a dynamic system without direct
measurement of it?
u y
Σ
x?
Gianluca Antonelli Evry, 27-29 march 2013
7. introduction
deterministic observer
stochastic observer
Open loop observer I
We build a copy of the system, feeded in parallel with the same input
u y
Σ
x
ˆ
x
Σ
Gianluca Antonelli Evry, 27-29 march 2013
8. introduction
deterministic observer
stochastic observer
Open loop observer II
Given an ISO system
c.t. d.t.
˙
x(t) = Ax(t) + Bu(t) x(k + 1) = Ax(k) + Bu(k)
y(t) = Cx(t) + Du(t) y(k) = Cx(k) + Du(k)
x ∈ Rn , u ∈ Rp , y ∈ Rm
ˆ
defining x(·) the x(·) estimate, we build
c.t. d.t.
˙
x(t) = Aˆ (t) + Bu(t)
ˆ x
ˆ
x(k + 1) = Aˆ (k) + Bu(k)
x
We define the error
Gianluca Antonelli Evry, 27-29 march 2013
10. introduction
deterministic observer
stochastic observer
Open loop observer IV
which is unsuitable for several reasons
The estimate dynamics is related to the eigenvalues of A and it
can not be modified
It is necessary to assume Σ asymptotically stable
Knowledge of the output (a linear combination of the state) is not
exploited
ˆ
The system is known with an identification error, only Σ is
available
Gianluca Antonelli Evry, 27-29 march 2013
11. introduction problem formulation
deterministic observer solution
stochastic observer exercises
Closed loop observer (Luenberger)
It is required to estimate the state by exploiting both the input and
the output
u y
Σ
x
ˆ
x
obs
Gianluca Antonelli Evry, 27-29 march 2013
12. introduction problem formulation
deterministic observer solution
stochastic observer exercises
Problem formulation c.t. and d.t. I
Given and ISO system
c.t. d.t.
˙
x(t) = Ax(t) + Bu(t) x(k + 1) = Ax(k) + Bu(k)
y(t) = Cx(t) + Du(t) y(k) = Cx(k) + Du(k)
x ∈ Rn , u ∈ Rp , y ∈ Rm
and the observer structure
c.t. d.t.
˙
ˆ ˆ
x(t) = F x(t) + Γ u(t) + Gy(t) ˆ ˆ
x(k+1) = F x(k)+Γ u(k)+Gy(k)
Gianluca Antonelli Evry, 27-29 march 2013
13. introduction problem formulation
deterministic observer solution
stochastic observer exercises
Problem formulation c.t. and d.t. II
it is necessary to design F , Γ and G such that:
c.t. d.t.
t→∞ ˆ
lim x(t) − x(t) = 0 ˆ
lim x(k) − x(k) = 0
k→∞
∀u(t), ∀x(0), ∀ˆ (0)
∀u(k), ∀x(0), ∀ˆ (0)
x x
i.e., that the estimate converge to the true value for all the initial
conditions of both the system and the observer and for all the possible
inputs
Gianluca Antonelli Evry, 27-29 march 2013
14. introduction problem formulation
deterministic observer solution
stochastic observer exercises
Solution c.t. and d.t. I
Defining the error
c.t. d.t.
ˆ
e(t) = x(t) − x(t) ˆ
e(k) = x(k) − x(k)
with dynamics:
c.t. d.t.
˙ ˙ ˙
e(t) = x(t) − x(t)
ˆ ˆ
e(k + 1)=x(k + 1) − x(k + 1)
= Ax(t) + Bu(t)+ = Ax(k) + Bu(k)+
ˆ
−F x(t) − Γ u(t) − Gy(t) ˆ
−F x(k) − Γ u(k) − Gy(k)
to make it independent from the input we impose Γ = B
Gianluca Antonelli Evry, 27-29 march 2013
15. introduction problem formulation
deterministic observer solution
stochastic observer exercises
Solution c.t. and d.t. II
assuming D = O and substituting y = Cx, it holds
c.t. d.t.
˙ ˆ
e(t) = (A − GC) x(t) − F x(t) ˆ
e(k+1) = (A − GC) x(k)−F x(k)
F is designed so that an homogeneous system holds:
F = A − GC
in this way the error dynamics is governed by the equation:
c.t. d.t.
˙
e(t) = F e(t) e(k + 1) = F e(k)
Gianluca Antonelli Evry, 27-29 march 2013
16. introduction problem formulation
deterministic observer solution
stochastic observer exercises
Solution c.t. and d.t. III
and thus the evolution:
c.t. d.t.
e(t) = eF t e(0) e(k) = F k e(0)
It is thus necessary that the eigenvalues of the dynamic matrix F all
stay in the stability region so that the error converges to zero
We need to design G and F (why it is not possible G = O and F = A?)
We design the n desired eigenvalues λd,i of F :
λd = {λd,1 , . . . , λd,n }
those give the coefficients of the desired characteristic polynomium:
n
(λ − λd,i ) = λn + d1 λn−1 + . . . + dn
i=1
Gianluca Antonelli Evry, 27-29 march 2013
17. introduction problem formulation
deterministic observer solution
stochastic observer exercises
Solution c.t. and d.t. IV
The characteristic polynomium
|λI − (A − GC)|
is thus fixed
The unknowns are the elements of the matrix G (why it is not possible
to solve a system by resorting to the identity principle of polynomia?)
Let us consider a scalar output, matrices C and G, thus, are row or
column vectors c and g
We compute the characteristic polynomium of A
|λI − A| = λn + a1 λn−1 + . . . + an
Gianluca Antonelli Evry, 27-29 march 2013
18. introduction problem formulation
deterministic observer solution
stochastic observer exercises
Solution c.t. and d.t. V
We compute the matrix:
an−1 an−2 . . . a1 1
an−2 an−3 ... 1 0
n−1 T
T = c T AT c T . . . AT c ...
... . . . . . . . . .
... ... . . . . . . . . .
1 0 ... 0 0
that is full rank if the first matrix is, i.e., O T (the transpose of the
observability matrix)
By defining
T
d = dn . . . d1
T
a = an . . . a1
Gianluca Antonelli Evry, 27-29 march 2013
19. introduction problem formulation
deterministic observer solution
stochastic observer exercises
Solution c.t. and d.t. VI
it is possible to write the Ackermann formula:
g = −T -T (a − d)
This gives univocally the unknown g, and thus the matrix F
Gianluca Antonelli Evry, 27-29 march 2013
20. introduction problem formulation
deterministic observer solution
stochastic observer exercises
Selection of the F eigenvalues
The observer needs to converge as fast as possible to the true value
Theoretically the eigenvalues may be placed everywhere in the complex
plane
In practice, a bound is given by the measurements noise
c.t. d.t.
I I
λa
λa
λd R λd R
1
Gianluca Antonelli Evry, 27-29 march 2013
21. introduction problem formulation
deterministic observer solution
stochastic observer exercises
Model knowledge
Let us assume C known, knowledge of B and A is affected by an error:
F ˆ ˜
= A − GC = A − A − GC
Γ ˆ
= B =B−B ˜
the error evolution is thus characterized by:
c.t. d.t.
˙ ˜x ˜
e(t) = F e(t) + Aˆ (t) + Bu(t) ˜x ˜
e(k +1) = F e(k)+ Aˆ (k)+ Bu(k)
that is not anymore homogeneous
˜
(A may exhibits unstable eigenvalues, it is an issue?)
Gianluca Antonelli Evry, 27-29 march 2013
22. introduction problem formulation
deterministic observer solution
stochastic observer exercises
Reduced observer I
If the system is not observable it is possible to implement a reduced
observer that gives and estimate of the sole observable component
By resorting to a proper matrix of equivalence the system is
transformed into the canonical form
c.t. d.t.
Ao O Ao O
˙
z(t) = z(t) + P −1 Bu(t) z(k + 1) = z(k) + P −1 Bu(k)
A1 Ano A1 Ano
y(t) = C o O z(t) y(k) = C o O z(k)
Gianluca Antonelli Evry, 27-29 march 2013
23. introduction problem formulation
deterministic observer solution
stochastic observer exercises
Reduced observer II
the observable dynamics, to be used to design the observer, is:
c.t. d.t.
˙
z o (t) = Ao z o (t) + P −1 B(1 : o, :)u(t) z o (k + 1) = Ao z o (k) + P −1 B(1 : o, :)u(k)
y(t) = C o z o (t) y(k) = C o z o (k)
of dimension o < n
It is meaningless to come back into the original state x
Gianluca Antonelli Evry, 27-29 march 2013
24. introduction problem formulation
deterministic observer solution
stochastic observer exercises
A feedback interpretation
The observer may be rewritten as
c.t. d.t.
˙ x ˆ
x(t) = Aˆ (t) + Bu(t) + G (y(t) − C x(t))
ˆ ˆ ˆ
x(k+1) = Aˆ (k)+Bu(k)+G (y(k) − C x(k))
x
thus
c.t. d.t.
˙ x ˆ
x(t) = Aˆ (t) + Bu(t) + G (y(t) − y (t))
ˆ ˆ ˆ
x(k+1) = Aˆ (k) + Bu(k) + G (y(k) − y (k))
x
emulation feedback emulation feedback
where it is possible to appreciate one component that emulate the
process and a feedback action on the output error, the matrix G plays
the role of a gain
Gianluca Antonelli Evry, 27-29 march 2013
25. introduction problem formulation
deterministic observer solution
stochastic observer exercises
Operative steps c.t./d.t.
Steps for the design of an asymptotic (Luenberger) observer:
1 impose Γ = B
2 compute the desired eigenvalues by assigning the vector d
3 compute the transformation matrix T
4 compute g
5 compute F
In case of vectorial output m > 1 it is possible to resort to proper
commands of numerical software under the description pole placement
(ex: ppol in Scilabor place in Matlab)
Gianluca Antonelli Evry, 27-29 march 2013
26. introduction problem formulation
deterministic observer solution
stochastic observer exercises
Extended Luenberger filter I
Assuming a nonlinear dynamic system
c.t. d.t.
˙
x(t) = f (x(t), u(t), t) x(k + 1) = f (x(k), u(k), k)
y(t) = h(x(t), t) y(k) = h(x(k), k)
by resorting to the closed-loop interpretation it is possible to write
c.t. d.t.
˙ x ˆ
x(t) = f (ˆ (t), u(t), t) + G (y(t) − y (t))
ˆ ˆ ˆ
x(k+1) = f (ˆ (k), u(k), k) + G (y(k) − y (k))
x
emulation feedback emulation feedback
Gianluca Antonelli Evry, 27-29 march 2013
27. introduction problem formulation
deterministic observer solution
stochastic observer exercises
Extended Luenberger filter II
where
ˆ
y (·) = h(ˆ (·), ·)
x
and the gain, both for the c.t. and the d.t., is computed by resorting to
the same formulas of the linear design where matrices A and C are
computed by linearization around the current estimate:
∂
C(·) = ∂ x h(x) x=x(·)
ˆ
∂
A(·) = ∂ x f (x) x=x(·)
ˆ
Gianluca Antonelli Evry, 27-29 march 2013
28. introduction problem formulation
deterministic observer solution
stochastic observer exercises
Exercise 1 I
Design a Luenberger observer for the system
0.9210 −0.1497 0.0352 −2
A = 0.0691 0.6841 0.0123 B = −1
−0.0842 0.2943 0.8525 −1
C = 0 −3 −1
Validate with a numerical simulation
step input with unitary amplitude
build two superblocks, one for the real model and one for the
observer
plot in the oscilloscope both the states and the estimate error
Gianluca Antonelli Evry, 27-29 march 2013
29. introduction problem formulation
deterministic observer solution
stochastic observer exercises
Exercise 2 I
Design a Luenberger observer for the RLC circuit
L with data
iL
iC Vu R = 680Ω
Vi R C L = 1.5 · 10−3 H (Rl = 0.4Ω)
−9
C = 5 · 10 F
Validate with a numerical simulation
square wave input with amplitude 3 Volt e frequency 7 KHz
final simulation time tf = 1 milliseconds
sampling time T = 0.4 microseconds
build two superblocks, one for the real model and one for the
observer
Gianluca Antonelli Evry, 27-29 march 2013
30. introduction problem formulation
deterministic observer solution
stochastic observer exercises
Exercise 2 II
plot in the oscilloscope both the states and the estimate error
Validate again with a numerical simulation and the real data stored in
the file RLC 02 small.txt
consider the sole observer superblock developed
import the data in the workspace via the command
A=read(’RLC 02 small.txt’,-1,3), the second column stores the
input, the third the output
read input and output of the real model from the workspace woth
the block From Workspace
notice that the output needs to be properly transalted to take into
account an acquisition error
Gianluca Antonelli Evry, 27-29 march 2013
31. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Definitions on stochastic variables I
Given a stochastic variabile x ∈ Rn with probability density
function fx (x) its expected value (average) is
E[x] = µx = xfx (x)dx ∈ Rn
Rn
The covariance matrix is defined as
P x = E (x − µx )(x − µx )T ∈ Rn×n
Gianluca Antonelli Evry, 27-29 march 2013
32. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Definitions on stochastic variables II
A multivariate Gaussian distribution is the function
1
e− 2 (x−µx ) P x (x−µx )
1 T
fx (x) =
(2π)n P
x
In the bidimensional case it exhibits a graphical interpretation
average µx
µx isopotential curves are ellipses
the principal axes of the ellipses
are parallel to the eigenvectors
v i of P x
the square root of a principal
v2 v1 axis is equal to the
corresponding eigevalue
Gianluca Antonelli Evry, 27-29 march 2013
33. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Definitions on stochastic variables III
x1
x2 v2
v1
µx
Gianluca Antonelli Evry, 27-29 march 2013
34. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Mathematical formulation
Given a stochastic dynamic system in the discrete time
x(k + 1) = f (x(k), u(k), k) + w(k)
y(k) = h(x(k), u(k), k) + v(k)
where
x ∈ Rn stato
y ∈ Rm uscita
u ∈ Rp ingresso
w ∈ Rn rumore di processo
v ∈ Rm rumore di misura
find an optimal estimation for x(k)
Gianluca Antonelli Evry, 27-29 march 2013
35. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Linear model
Let us consider first the stationary linear model
x(k + 1) = Ax(k) + Bu(k) + w(k)
y(k) = Cx(k) + v(k)
where
E[w(k)] = 0
E[v(k)] = 0
E[w(i)w(j)T ] = Rw δ(i − j) con Rw > O
E[v(i)v(j)T ] = Rv δ(i − j) con Rv > O
E[wh (i)vl (j)] = 0 per ogni i, j, h, l
E[xh (i)vl (j)] = 0 per ogni i, j, h, l
Gianluca Antonelli Evry, 27-29 march 2013
36. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Variable definition
ˆ
x(k) estimate k|k
x(k) estimate k|k − 1
˜
x(k) ˜ ˆ
error x(k) = x(k) − x(k)
P (k) estimate error covariance k|k
P (k) estimate error covariance k|k − 1
✻ˆ ✻ˆ
x(k) x(k+1) x(k+1)
temporal update
✲
P (k) P (k+1) P (k+1)
k k+1
Gianluca Antonelli Evry, 27-29 march 2013
37. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Kalman filter equations
temporal update x(k + 1)
= Aˆ (k) + Bu(k)
x
(prediction)
P (k + 1)
= AP (k)AT + Rw
−1
measurement update K(k) = P (k)C T Rv + CP (k)C T
(correction) ˆ
x(k)
= x(k) + K(k) [y(k) − Cx(k)]
P (k) = P (k) − K(k)CP (k)
Update equations not necessarily synchronous
Possibility to fuse/merge different measurement sources
Suitable to be implemented for the non stationary case
Gianluca Antonelli Evry, 27-29 march 2013
38. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Sketch
model measurement
ˆ
x(k) x(k + 1) ˆ
x(k + 1)
prediction correction
Gianluca Antonelli Evry, 27-29 march 2013
39. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Gain geometric interpretation I
Let us formulate a geometric interpretation of the term
∆x = K(k) [y(k) − Cx(k)]
that appears in the measurement update
ˆ
x(k) = x(k) + K(k) [y(k) − Cx(k)] = x(k) + ∆x
From the output equation we have
y(k) = C (x(k) + ∆x) + v(k)
assuming first absence of noise, it allows to write the following
minimization problem
min ∆x P s.t. C∆x = y(k) − Cx(k)
Gianluca Antonelli Evry, 27-29 march 2013
40. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Gain geometric interpretation II
where
∆x P = ∆xT P (k)−1 ∆x
Notice
the equation y = Cx represents an affine subspace of dimension m
in the state space
the Mahalanobis norm ∆x P wheigths more the better estimated
state components
the problem is underconstrained ⇒ infinite solutions ∆x exists
the state is a stochastic variable with probability density function
of kind Gaussian multivariate
Gianluca Antonelli Evry, 27-29 march 2013
41. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Gain geometric interpretation III
The minimum norm solution is
−1
∆x = C † (y(k) − Cx(k)) = P C T CP C T (y(k) − Cx(k))
By adding measurement noise with covariance Rv one obtains the gain
formula
−1
∆x = P C T CP C T + Rv (y(k) − Cx(k))
Gianluca Antonelli Evry, 27-29 march 2013
42. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Gain geometric interpretation
In the numeric case:
x2
x(k)
n = 2
m = 1
y(k) = Cx(k) C = 1 1
x1
Gianluca Antonelli Evry, 27-29 march 2013
43. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Gain geometric interpretation
without noise and symmetric covariance
x2
n = 2
m = 1
x(k)
C = 1 1
∆x 1 0
P (k) =
0 1
y(k) = Cx(k)
Rv = 0
1
K(k) =
1
x1
Gianluca Antonelli Evry, 27-29 march 2013
44. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Gain geometric interpretation
without noise and asymmetric covariance
x2
n = 2
m = 1
x(k)
C = 1 1
∆x 1 0
P (k) =
0 2
y(k) = Cx(k)
Rv = 0
1
K(k) = 13 2
x1
Gianluca Antonelli Evry, 27-29 march 2013
45. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Gain geometric interpretation
with noise the subspace is uncertain:
x2
n = 2
m = 1
x(k)
C = 1 1
∆x 1 0
P (k) =
0 2
y(k) = Cx(k)
Rv = 1
1
K(k) = 14 2
x1
Gianluca Antonelli Evry, 27-29 march 2013
46. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Covariance dynamics
The filter may be interpreted even as propagation of the
prediction-correction estimate average value and covariance
x(k + 1) = 0.9x(k) + w(k)
x(k)
y(k) = x(k) + v(k)
with
x(k) ˆ
x(k)
Rw = rw = 1
Rv = rv = 0.5
ˆ
x(k)
x(k + 1)
Gianluca Antonelli Evry, 27-29 march 2013
47. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Gain matrix I
An alternative formulation
K(k) = P (k)C T Rv
−1
where it is possible to notice
Proportional to the error covariance
Inversely proportional to the measurement error covariance
The process noise covariance influences P (k)
when Rw = O ⇒ P (k) → O and K(k) → O
The relative wheight between measurement and process noise
covariances represents the relative trust between model and
measurement
Good model ⇒ small gain
Good measurement ⇒ large gain
Gianluca Antonelli Evry, 27-29 march 2013
48. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Gain matrix II
Under assumptions of
linearity
stazionarity
observability
reachability
K(k) → K ∞
with K ∞ solution of the Riccati equation
−1
K ∞ = P ∞ C T Rv + CP ∞ C T
Gianluca Antonelli Evry, 27-29 march 2013
49. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
The optimum transient observer
We search the gain K(k) such that:
ˆ
E[x − x] = 0
P (k) minimum
⇓
The solution is formally equal to the Kalman filter
Gianluca Antonelli Evry, 27-29 march 2013
50. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Witheness of the innovation
We search the gain K(k) such that:
E e(i)e(j)T = Rv δ(i − j)
with e(k) = y(k) − Cx(k) (innovation)
⇓
The solution is formally equal to the Kalman filter
The hortogonality between estimate and error holds
E x(k)˜ (k)T = O
ˆ x
Gianluca Antonelli Evry, 27-29 march 2013
51. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Stability
The state estimate evolves following the dynamics
ˆ ˆ
x(k) = (A − K(k)CA) x(k − 1)
An anlytical proof requires hard constraints
When the system is observable E[˜ (k)] is bounded ∀k
x
Stable for most of practical applications
Gianluca Antonelli Evry, 27-29 march 2013
52. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Example: estimate of a constant I
We have at disposal the noisy measurement of a constant with trivial
dynamic
x(k + 1) = x(k) no noise ⇒ (I trust the model!)
y(k) = x(k) + v(k)
where A = 1, H = 1 e E[v(i)v(j)] = rv δ(i − j)
The covariance matrix is given P (0) = p(0) = p0
Gianluca Antonelli Evry, 27-29 march 2013
53. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Example: estimate of a constant II
The update equations of the error covariance and of the gain are:
p(k)
K(k) =
rv + p(k)
p(k)rv
p(k) =
rv + p(k)
p(k + 1) = p(k)
(the scalar gain K is now scalar but we keep it in boldface to differentiate it from
the time)
Gianluca Antonelli Evry, 27-29 march 2013
54. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Example: estimate of a constant III
At the initial instant we have:
p0
K(0) =
rv + p0
p 0 rv
p(0) =
rv + p0
p(1) = p(0)
for k = 1 we got:
p(1) p(0) p0 rv p0
K(1) = = = 2 =
rv + p(1) rv + p(0) rv + p0 rv + p0 rv rv + 2p0
p0 rv
p(1) =
rv + 2p0
p0 rv
p(2) =
rv + 2p0
Gianluca Antonelli Evry, 27-29 march 2013
55. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Example: estimate of a constant IV
by iteration it is possible to compute symbolically the gain as
p0 p0 /rv
K(k) = =
rv + (k + 1)p0 1 + (k + 1)p0 /rv
the estimate is then given by:
p0 /rv
x(k) = x(k) +
ˆ [y(k) − x(k)]
1 + (k + 1)p0 /rv
where we notice
for increasing k, the new measurements are not used anymore to
update the estimate
the gain is strongly affected by the ration between p0 and rv
to avoid that the gain tends to zero it is necessary to introduce a
process noise
Gianluca Antonelli Evry, 27-29 march 2013
56. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Extended Kalman filter
Idea: we use the nonlinear function whenever possible, otherwise we
use the Jacobians (dynamics linearization):
ˆ
C(k) = ∂
∂ x h(x) x=x(k)
ˆ
A(k) = ∂
∂ x f (x) x=x(k)
ˆ
−1
K(k) ˆ ˆ ˆ
= P (k)C(k)T Rv + C(k)P (k)C(k)T
ˆ
x(k) = x(k) + K(k) [y(k) − h(x(k), k)]
P (k) = ˆ
P (k) − K(k)C(k)P (k)
x(k + 1) = f (ˆ (k), k) + Bu(k)
x
P (k + 1) = ˆ ˆ
A(k)P (k)A(k)T + Rw
Gianluca Antonelli Evry, 27-29 march 2013
57. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Example: estimate of the model’s parameters I
Possible use: estimate the value of the constant value of the parameter
of a physical model
Let us assume θ as the vector of the model unknown parameters
The model is:
x(k + 1) = f (x(k), u(k), θ, k) + w(k)
y(k) = h(x(k), θ, k) + v(k)
Idea: we consider such parameters, constants, as additional states of
the system with dynamics:
θ(k + 1) = θ(k) + wθ
Let us define the extended state vector:
x
xE =
θ
Gianluca Antonelli Evry, 27-29 march 2013
58. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Example: estimate of the model’s parameters II
the moidel becomes:
xE (k + 1) = f E (xE (k), u(k), k) + wE (k)
y(k) = h(xE (k), k) + v(k)
where
w
wE =
wθ
The noise wθ represents the uncertainty of the parameter’s value
The filter admits thus its variation
Be careful, it is a nonlinear operation
Gianluca Antonelli Evry, 27-29 march 2013
59. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Example: shuttle reentry I
We want to design an estimate for the state of a shuttle in reentry
phase within the atmosphere at large altitude and large velocity
We define a reference frame y − x attached to the earth
x
x4
x3
x1 position along x
x2 − y r x2 position along y
x1 − xr x3 velocity along x
x4 velocity along y
x5 model parameter
yr
xr y
Gianluca Antonelli Evry, 27-29 march 2013
60. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Example: shuttle reentry II
By defining
r(t) = x2 (t) + x2 (t)
1
2
v(t) = x2 (t) + x4 (t)
3
2
the c.t. model is
x1 (t)
˙ = x3 (t)
x2 (t)
˙ = x4 (t)
x3 (t)
˙ = d(t)x3 (t) + g(t)x1 (t)
x4 (t)
˙ = d(t)x4 (t) + g(t)x2 (t)
x5 (t)
˙ = 0
where
r0 −r(t)
d(t) = d(x1 , x2 , x5 ) = −β0 ex5 (t) e h0
v(t)
g(t) = − gm0
r 3 (t)
Gianluca Antonelli Evry, 27-29 march 2013
61. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Example: shuttle reentry III
The measurement, obtained by a radar placed in xr , yr , gives
y1 (t) = (x1 (t) − xr )2 + (x2 (t) − yr )2 + v1
x2 (t)−yr
y2 (t) = atan2 x1 (t)−xr + v2
We know the data (proper unit measurmenets where absent):
β0 = 0.597
h0 = 13.406 km
gm0 = 3.9860 · 105
xr = 6374 km
yr = 0 ⇒ r0 = xr
T = 0.1 s
rv1 = 1
rv2 = 17 · 10−3
T
x(0) = 6500 349 −1.8 −6.8 0.7
Gianluca Antonelli Evry, 27-29 march 2013
62. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Example: shuttle reentry IV
The dynamic discretization gives
x1 (k + 1) = x1 (k) + T x3 (k)
x2 (k + 1) = x2 (k) + T x4 (k)
x3 (k + 1) = (1 + T d(k))x3 (k) + T g(k)x1 (k)
x4 (k + 1) = (1 + T d(k))x4 (k) + T g(k)x2 (k)
x5 (k + 1) = x5 (k)
on which it is possible to design a proper extended Kalman filter
Gianluca Antonelli Evry, 27-29 march 2013
63. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Example: shuttle reentry V
6500
Simulated reentry path
6480
6460
6440
x [km]
6420
6400
6380 radar
6360
6340
6320
6300
-50 0 50 100 150 200 250 300 350
y [km]
Gianluca Antonelli Evry, 27-29 march 2013
67. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Example: shuttle reentry IX
x1 ,x2 ,x3 ,x4 ,x5 , [km],[km/s],[-]
3
˜
x(k)
2
1
0
-1
-2
-3
-4
-5
0 20 40 60 80 100 120 140 160 180 200
t [s]
Numerical example taken from: Austin, JW and Leondes, CT, Statistically
linearized estimation of reentry trajectories, Aerospace and Electronic Systems,
IEEE Transactions on, (1)54–61, 1981
Gianluca Antonelli Evry, 27-29 march 2013
68. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Kalman vs Luenberger
Luenberger is based on the deterministic model
In Luenberger we design the estimate convergence speed
Different interpretation of models/data
At steady state they are simbolically equal. When K(k) = K,
Kalman becomes
x(k + 1)
= Aˆ (k) + Bu(k)
x
P (k + 1)
= P
K(k) = K
ˆ
x(k)
= x(k) + K [y(k) − Cx(k)]
P (k) = P
thus
ˆ ˆ
x(k + 1) = Aˆ (k) + Bu(k) + K [y(k) − y (k)]
x
Gianluca Antonelli Evry, 27-29 march 2013
69. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Case study I
Position estimate via differential measurements
Given x(k) ∈ R for which it is available a differential measurement
y(k) = x(k) − x(k − 1) + v(k)
one possible estimator is given by
x(k + 1) =
ˆ x(k)
ˆ + x(k + 1) − x(k) + v(k)
current estimate increment
with corresponding error dynamics:
e(k + 1) = x(k + 1) − x(k + 1)
ˆ
= x(k + 1) − x(k) − x(k + 1) + x(k) − v(k)
ˆ
= e(k) − v(k)
Gianluca Antonelli Evry, 27-29 march 2013
70. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Case study II
The error is thus a Brownian movement (random walking)
e(k + 1) = e(k) + v(k)
E[e(0)] = 0
E[e2 (0)] = 0
E[e2 (1)] = E[(e(0) + v(0))2 ]
= E[e2 (0) + 2e(0)v(0) + v 2 (0)]
2
= rv
E[e (2)] = E[(e(1) + v(1))2 ]
2
= E[e2 (1) + 2e(1)v(1) + v 2 (1)]
2
= 2rv
.
.
.
E[e2 (k)] = krv
2
the variance grows!
Gianluca Antonelli Evry, 27-29 march 2013
71. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Case study
Mapping
known vehicle position
relative measurement vehicle-landmark
Gianluca Antonelli Evry, 27-29 march 2013
72. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Case study
map built with the sole odometry
Gianluca Antonelli Evry, 27-29 march 2013
73. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Case study
Localization
landamark coordinates (map) known
relative measurement vehicle-landmark
Gianluca Antonelli Evry, 27-29 march 2013
74. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Case study
a localization example
Gianluca Antonelli Evry, 27-29 march 2013
75. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Case study
SLAM
strarting from an unkown intial position in an unknown
environment, the robot should incrementally build a map while
locating itself within the map
Gianluca Antonelli Evry, 27-29 march 2013
76. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Case study
SLAM
x is built with both the landmark and vehicle coordinates
relative measurement vehicle-landmark
Gianluca Antonelli Evry, 27-29 march 2013
77. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Case study I
x = xv p1 . . . pN
T xv ∈ R2 posizione del veicolo
pi ∈ R2 posizione del landmark
the dynamic model is thus given by:
F (k) O · · ·
O xv (k) uv (k) wv (k)
xv (k + 1)
p1 (k + 1) O I ··· O p1 (k) 0 w1 (k)
= . .
. ... + ... + ...
... .
. .
. .
.
pN (k + 1) O O ··· I pN (k) 0 wN (k)
the output is characterized by a time-varying matrix with generic
p i − xv
Gianluca Antonelli Evry, 27-29 march 2013
78. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Case study II
thus
y(k) = C(k)x(k) + v(k)
with the C(k) elements properly assumed as 1/0
Gianluca Antonelli Evry, 27-29 march 2013
79. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Case study
SLAM example
Gianluca Antonelli Evry, 27-29 march 2013
80. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Beyond Kalman
Kalman is optimal when the assumptions are met:
linearity
Gaussian noises
more complex situations require additional effort
Gianluca Antonelli Evry, 27-29 march 2013
81. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Exercise 1 I
Design a Kalman filter for the system
0.9210 −0.1497 0.0352 −2
A = 0.0691 0.6841 0.0123 B = −1
−0.0842 0.2943 0.8525 −1
C = 0 −3 −1
Validate with a numerical simulation
step input with unitary amplitude
consider using the file template kalman.sce downloadable from
the website
run several simulations by varying measurement and process
covariances
Gianluca Antonelli Evry, 27-29 march 2013
82. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Exercise 2 I
Design a Kalman filter for the system
L with data
iL
iC Vu R = 680Ω
Vi R C L = 1.5 · 10−3 H (Rl = 0.4Ω)
−9
C = 5 · 10 F
Validate with a numerical simulation
square wave input with amplitude 3 Volt e frequency 7 KHz
final simulation time tf = 1 milliseconds
sampling time T = 0.4 microseconds
consider using the file template kalman.sce downloadable from
the website
Gianluca Antonelli Evry, 27-29 march 2013
83. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Exercise 2 II
Validate again with a numerical simulatino and the real data stored in
the file RLC 02 small.txt
import the data in the workspace via the command
A=read(’RLC 02 small.txt’,-1,3), the second column stores the
input, the third the output
notice that the output needs to be properly transalted to take into
account an acquisition error
Gianluca Antonelli Evry, 27-29 march 2013
84. introduction problem formulation
deterministic observer solution
stochastic observer examples and exercises
Merci!
Gianluca Antonelli Evry, 27-29 march 2013