Interacting Multiple Model Kalman ... -...

45
Interacting Multiple Model Kalman Filters (IMMKF) Interacting Multiple Model Kalman Filters (IMMKF) Henrique M. Menegaz Pedro Henrique R.Q.A. Santana 03 de julho de 2009. Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Transcript of Interacting Multiple Model Kalman ... -...

Page 1: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Interacting Multiple Model Kalman Filters(IMMKF)

Henrique M. Menegaz Pedro Henrique R.Q.A. Santana

03 de julho de 2009.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 2: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Sumário1 Introdução

Abordagens de múltiplos modelosIntrodução ao Interacting Multiple Model (IMM)

2 Estado da Arte3 Interacting Multiple Model

Descrição do sistemaMotivação para o algoritmoO Algoritmo IMMDiscussão

4 Modelos Múltiplos Autônomos (AMM)5 Exemplo

Descrição do problemaModelagem do CTAMovimento Uniforme (MU)Modelo de ManobraLinearização da funçãoModelo EKF para CT final

6 Simulação7 Conclusões8 Referências bibliográficas

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 3: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Introdução

Introdução

Situação 1

Um sistema de segurança industrial monitora o transcorrer de umprocesso químico. Em caso de falha, o processo necessita ser ime-diatamente encerrado e um alarme acionado para que a fábrica sejaevacuada. Com medo de depender de um técnico para tarefa tão de-licada, o gerente dá ao engenheiro encarregado a tarefa de projetarum sistema automático de detecção de falha. Estando disponíveisapenas medições ruidosas do processo, como fazer para estimar apresença de problemas?

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 4: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Introdução

Situação 2

Um sistema de controle de tráfego aéreo faz uso de leituras de rada-res para determinar as posições de diferentes aeronaves. Entretanto,por limitações do equipamento, a quantidade de objetos passíveis dedetecção pelos radares é limitada, não sendo possível obter leiturasde posição de todos as aeronaves simultaneamente. Além disso, apresença de ruído corrompe as medidas e dificulta a obtenção deestimativas de posição. Como fazer para estimar as coordenadas decada aeronave para evitar colisões?

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 5: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Introdução

Situação 3

Um engenheiro é incumbido da tarefa de determinar os modelosde diferentes motores que fazem parte de equipamentos recém-adquiridos pela empresa. Os equipamentos foram instalados e postosem operação e não houve cuidado em se documentar a descrição decada um deles. Agora, o engenheiro sabe as características técnicasde todos os modelos de motores existentes, mas não pode desmon-tar os equipamentos para determinar quem é quem. Tendo apenasmedições de entrada e saída dos motores, o que pode ser feito parase determinar o modelo mais provável de cada um deles?

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 6: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Introdução

Abordagens de múltiplos modelos

Abordagens de múltiplos modelos

Motivados pelas situações apresentadas, consideremos as seguinteshipóteses:

O sistema em estudo transita entre diferentes modos (estadosdiscretos), cada um deles caracterizado por um modelodinâmico distinto (Figura 1);

Sabe-se que o sistema obedece um dentre vários diferentesmodelos, mas não se sabe qual (Figura 2).

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 7: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Introdução

Abordagens de múltiplos modelos

Figura 1: Sistema híbrido com chaveamento entre modelos.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 8: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Introdução

Abordagens de múltiplos modelos

Figura 2: Hipóteses de modelo para um mesmo sistema.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 9: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Introdução

Introdução ao Interacting Multiple Model (IMM)

Introdução ao Interacting Multiple Model (IMM)

Artigo introdutor: H.A.P. Blom, An Efficient Filter for AbruptlyChanging Systems, 1984 [1].Motivação para o desenvolvimento do algoritmo: problema derastreamento de aeronaves em sistemas de controle de tráfegoaéreo.

Necessidade de rastreamento de aeronaves nos modos de vôoretilíneo e manobras.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 10: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Introdução

Introdução ao Interacting Multiple Model (IMM)

Segundo [2], temos:

O estimador IMM é um filtro híbrido subótimo;

É uma das melhores opções para estimação híbrida em termosde custo e eficiência;

Sua principal característica é a sua habilidade de estimar o es-tado de um sistema dinâmico com diferentes modelos que cha-veiam entre si;

Filtro auto-ajustável com largura de banda variável;Bom compromisso entre complexidade computacional e desem-penho:

Custo computacional aproximadamente linear em relação ao nú-mero de modos;Desempenho muito semelhante ao de algoritmos com comple-xidade quadrática.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 11: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Estado da Arte

Estado da Arte

IntrodutoresH.A.P. Blom, An Efficient Filter for Abruptly Changing Systems,1984 [1];H.A.P. Blom e Y. Bar-Shalom, The Interacting Multiple ModelAlgorithm for Systems with Markovian Switching Coefficients,1988 [3].

DesempenhoX.R. Li e Y. Bar-Shalom, Performance Prediction of the Inte-racting Multiple Model Algorithm, 1993 [4];L.A. Johnston e V. Krishnamurthy, An Improvement to the In-teracting Multiple Model (IMM) Algorithm, 2001 [5];T. Kirubarajan e Y. Bar-Shalom, Kalman Filter Versus IMMEstimator: When Do We Need the Latter?, 2003 [6];C.E. Seah e I. Hwang, Stability Analysis of the Interacting Mul-tiple Model Algorithm, 2008 [7];

Métodos de estimação diferentes do Filtro de KalmanY. Boers e J.N. Driessen, Interacting multiple model particlefilter, 2003 [8];J. Wang, D. Zhao, W. Gao e S. Shan, Interacting MultipleModel Particle Filter To Adaptive Visual Tracking, 2004 [9];R. Guo, Z. Qin, X. Li e J. Chen, Interacting Multiple ModelParticle-type Filtering Approaches to Ground Target Tracking,2008 [10];

TelecomunicaçõesC. Ramesh e V. Vaidehi, IMM Based Kalman Filter for ChannelEstimation in UWB OFDM Systems, 2007 [11];

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 12: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Estado da Arte

Rastreamento e estimaçãoA. Houles e Y. Bar-Shalom, Multisensor Tracking of a Maneu-vering Target in Clutter, 1989 [12];X.R. Li e Y. Bar-Shalom, Design of an Interacting Multiple Mo-del Algorithm for Air Traffic Control Tracking, 1993 [13];M. Yeddanapudi, Y. Bar-Shalom e K.R. Pattipati, IMM Estima-tion for Multitarget-Multisensor Air Traffic Surveillance, 1997[14];E. Mazor, A. Averbuch, Y. Bar-Shalom e J. Dayan, InteractingMultiple Model Methods in Target Tracking: A Survey, 1998 [2];W. Schmaedeke e K. Kastella, Sensor Management using Discri-mination Gain and Interacting Multiple Model Kalman Filters,1998 [15];Y. Bar-Shalom, X.R. Li e T. Kirubarajan, Estimation with Ap-plications to Tracking and Navigation, 2001 [16];I. Hwang, H. Balakrishnan e C. Tomlin, State estimation forhybrid systems: applications to aircraft tracking, 2006 [17];J. Burlet, O. Aycard, A. Spalanzani e C. Laugier, PedestrianTracking in car parks : an Adaptive Interacting Multiple Modelsbased Filtering Method, 2006 [18];J.B.B. Gomes, An Overview on Target Tracking Using MultipleModel Methods, 2008 [19];M.E. Farmer, R.L. Hsu e A.K. Jain, Interacting Multiple Model(IMM) Kalman Filters for Robust High Speed Human MotionTracking, [20].

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 13: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Interacting Multiple Model

Descrição do sistema

Descrição do Sistema

Sistema linear com saltos Markovianos

xk = A(θk)xk−1 + B(θk)vk

yk = C(θk)xk + D(θk)wk (1)

θk ∈ 1, . . . ,N é uma cadeia de Markov com matriz detransição H;

vk ∼ N(0,Q) e wk ∼ N(0,R) são processos Gaussianosindependentes;

As matrizes A(θi), B(θi), C(θi) e D(θi) são conhecidas paracada modo θi .

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 14: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Interacting Multiple Model

Motivação para o algoritmo

Motivação para o Algoritmo

Considere o processo Markoviano (xk , θk) descrito por (1). Dado umconjunto de medidas ruidosas Yk obtidas até o instante k, queremosestimativas tanto do estado xk quanto do modo θk do sistema noinstante k.

Contudo, a transição θj → θi entre os modos do sistema é des-conhecida, supondo-se conhecidas apenas as probabilidades Hi ,j damatriz de transição de estados H.

Como fazer para estimar xk e θk?

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 15: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Interacting Multiple Model

Motivação para o algoritmo

Segundo [3], podemos dividir o problema em cinco partes. Supondoθk = i , i ∈ 1, . . . ,N, temos

1 Estimar a probabilidade do modo por predição;

P [θk−1|Yk−1]→ P [θk |Yk−1]

2 Atualizar a distribuição de xk−1 a partir da atualização de θk ;

p [xk−1|θk−1,Yk−1]→ p [xk−1|θk ,Yk−1]

3 Propagar a estimativa xk por predição;

p [xk−1|θk ,Yk−1]→ p [xk |θk ,Yk−1]

4 Corrigir a estimativa xk por meio da nova medição;

p [xk |θk ,Yk−1]→ p [xk |θk ,Yk ]

5 Corrigir a probabilidade do modo θk = i por meio da novamedição;

P [θk |Yk−1]→ P [θk |Yk ]

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 16: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Interacting Multiple Model

Motivação para o algoritmo

Determinemos expressões para cada um dos passos anteriores

1 Aplicando a equação de Chapman-Kolmogorov à cadeia deMarkov θk , temos

P [θk = i |Yk−1] =∑

j

Hi ,jP [θk−1 = j |Yk−1]→ θk|k−1. (2)

2 A partir da Lei da Probabilidade Total, temos a expressão

p [xk−1|θk = i ,Yk−1] =∑

j

[p [xk−1|θk−1 = j, θk = i ,Yk−1]

·P [θk−1 = j|θk = i ,Yk−1]] (3)

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 17: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Interacting Multiple Model

Motivação para o algoritmo

Como θk é independente de xk−1 se θk−1 é conhecido1, chega-se àexpressão

p [xk−1|θk−1 = j, θk = i ,Yk−1] = p [xk−1|θk−1 = j,Yk−1] . (4)

Pela fórmula de Bayes,

P [θk−1 = j |θk = i ,Yk−1] = Hi ,jP [θk−1 = j |Yk−1]

P [θk = i |Yk−1]. (5)

Substituindo (4) e (5) em (3), temos

p [xk−1|θk = i ,Yk−1] =∑

j

Hi,jP [θk−1 = j|Yk−1]p [xk−1|θk−1 = j,Yk−1]

P [θk = i |Yk−1]

(6)

1A transição de estados em uma cadeia de Markov é função apenas doestado anterior.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 18: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Interacting Multiple Model

Motivação para o algoritmo

3 Etapa de predição do Filtro de Kalman a partir do modelo (1)

xk|k−1 = A(θk|k−1)xk−1 (7)

Pk|k−1 = A(θk|k−1)Pk−1A(θk|k−1)T + B(θk|k−1)QB(θk|k−1)

T (8)

4 Etapa de correção da estimativa do Filtro de Kalman

Kk = Pk|k−1C(θk|k−1)T(

C(θk|k−1)Pk|k−1C(θk|k−1)T

+ D(θk|k−1)RD(θk|k−1)T)−1

(9)

xk = xk|k−1 + Kk (yk − C(θk|k−1)xk|k−1) (10)

Pk = (I− Kk C(θk|k−1))Pk|k−1(I− Kk C(θk|k−1))T

+ Kk D(θk|k−1)RD(θk|k−1)T

KTk (11)

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 19: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Interacting Multiple Model

Motivação para o algoritmo

5 Definindo yk como a medição tomada no instante k, temos aseguinte relação a partir da fórmula de Bayes

p (θk |Yk ) = p (θk |yk ,Yk−1) =p (yk |θk ,Yk−1) p (θk |Yk−1)

p (yk |Yk−1)→ θk (12)

Observação

Para uma cadeia de Markov θk ∈ 1, . . . ,N, o algoritmo IMMutiliza N Filtros de Kalman, cada um deles estimando osparâmetros do modelo θk = i , i ∈ 1, . . . ,N.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 20: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Interacting Multiple Model

O Algoritmo IMM

O Algoritmo IMM

De acordo com [1, 3], o algoritmo IMM consiste dos quatro passosseguintes:

1 Sejam pn(k − 1) a probabilidade do modo θk−1 = n, xn(k − 1) aestimativa do Filtro de Kalman que rastreia o modo θk = n noinstante k − 1 e Pn(k − 1) sua matriz de covariância associada. Acondição inicial combinada, no instante k , para o Filtro de Kalmanque rastreia o modo θk = i , i ∈ 1, . . . ,N, é calculada por meiodas equações

pi (k) =

j

Hi,j pj (k − 1), pi (k) 6= 0, (13)

xi(k − 1) =

j

Hi,j pj (k − 1)xj (k − 1)

pi (k), (14)

Pi(k − 1) =

j

Hi,j pj (k − 1)[

Pj (k − 1) +(

xj (k − 1) − x i (k − 1))

(·)T]

pi (k). (15)

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 21: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Interacting Multiple Model

O Algoritmo IMM

2 O par (x i (k − 1), P i(k − 1)) é usado como condição inicial para oFiltro de Kalman que rastreia o modo θk = i , i ∈ 1, . . . ,N. Aetapa de predição gera (xi(k), Pi(k)), seguido do resultado(xi (k), Pi(k)) da etapa de correção.

3 A probabilidade predita pi(k) do modo θk = i é atualizada a partirda inovação do Filtro de Kalman de seu modo

ϑi(k) = yk − C(i)xi (k),

Vi(k) = C(i)Pi (k)CT (i) + D(i)RDT (i),

pi(k) =pi(k)

c‖Vi (k)‖12

exp

−1

Ti (k)V−1

i (k)ϑi(k)

,

em que c é uma constante de normalização.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 22: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Interacting Multiple Model

O Algoritmo IMM

4 Finalmente, as saídas do estimador podem ser dadas por

xk =∑

i

pi(k)xi(k),

Pk =∑

i

pi(k)[

Pi(k) + (xi(k)− xk) (·)T]

.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 23: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Interacting Multiple Model

Discussão

Discussão

A evolução das estimativas no algoritmo IMM advém diretamentedas equações anteriormente apresentadas:

Passo 1 → Equações (2) e (6);

Passo 2 → Equações (7)-(11);

Passo 3 → Equação (12);

Dentre os passos do algoritmo, apenas 1 é típico do IMM [3].Dentre suas equações, (14) e (15), derivadas de (6), merecematenção especial. A equação (13) é a mesma que (2). O Passo 2 éuma aplicação direta das equações do Filtro de Kalman, enquantoo Passo 3 é um resultado simples da fórmula de Bayes.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 24: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Interacting Multiple Model

Discussão

Uma questão razoável neste momento:

Questão

Qual é a justificativa para a etapa de combinação de estimativasdo Passo 1 do algoritmo IMM, descrita por (14) e (15)?

Esta questão pode ser respondida por meio da análise de (6), repe-tida abaixo por conveniência

p [xk−1|θk = i ,Yk−1] =∑

j

Hi,jP [θk−1 = j|Yk−1]p [xk−1|θk−1 = j,Yk−1]

P [θk = i |Yk−1]

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 25: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Interacting Multiple Model

Discussão

Reescrevendo a equação, temos

p [xk−1|θk = i ,Yk−1] =∑

j

αjp [xk−1|θk−1 = j,Yk−1]

Mesmo que p[x0|Y0] seja Gaussiano, em geral p[xk |θk = i ,Yk ] éuma soma ponderada de Nk−1 Gaussianas [3]. Esta soma é frutode nosso desconhecimento acerca das transições entre os modos dosistema e o diagrama da Figura 3 procura ilustrá-lo.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 26: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Interacting Multiple Model

Discussão

Figura 3: Diagrama de evolução do histórico dos modos.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 27: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Interacting Multiple Model

Discussão

Com o aumento do número k de iterações, o custo computacio-nal de processamento de p [xk−1|θk = i ,Yk−1] torna-se proibitivo einviabiliza uma abordagem de estimação ótima, visto que seria ne-cessário um filtro associado a cada um dos possíveis históricos dosmodos [3, 19,16].

O que fazer?

p [xk−1|θk−1 = i ,Yk−1] ∼ N(xi(k − 1), Ri(k − 1)) (16)

(Abordagem de fusão com profundidade fixa - Fixed depth mergingapproach [3])

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 28: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Interacting Multiple Model

Discussão

Com o aumento do número k de iterações, o custo computacio-nal de processamento de p [xk−1|θk = i ,Yk−1] torna-se proibitivo einviabiliza uma abordagem de estimação ótima, visto que seria ne-cessário um filtro associado a cada um dos possíveis históricos dosmodos [3, 19,16].

O que fazer?

p [xk−1|θk−1 = i ,Yk−1] ∼ N(xi(k − 1), Ri(k − 1)) (16)

(Abordagem de fusão com profundidade fixa - Fixed depth mergingapproach [3])

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 29: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Interacting Multiple Model

Discussão

Substituindo (16) em (6) e definindo W = xk−1|θk = i ,Yk−1,temos

p [W ] =∑

j

Hi,jP [θk−1 = j|Yk−1]p [xk−1|θk−1 = j,Yk−1]

P [θk = i |Yk−1],

x i(k − 1) , E W

=∑

j

Hi,j pj(k − 1)xj(k − 1)

pi (k)→ (14),

P i (k − 1) , E

(W − EW )(W − EW )T

,

=∑

j

Hi,j pj(k − 1)[

Pj(k − 1) +(

xj(k − 1)− x i (k − 1))

(·)T]

pi (k)→ (15).

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 30: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Interacting Multiple Model

Discussão

Figura 4: Diagrama do algoritmo IMM.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 31: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Modelos Múltiplos Autônomos (AMM)

Modelos Múltiplos Autônomos (AMM)

1 Caso particular do IMM =⇒ H = IN×N ;2 Cada filtro opera de forma independente;3 Suposições:

O modelo verdadeiro é invariante no tempo;o modelo verdadeiro sempre opera como um dos modos domodelo.

4 Não lida adequadamente com sistemas que transitam entre osseus modos.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 32: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Exemplo

Descrição do problema

Descrição do problema

Problema

Rastreador para um sistema de Controle de Tráfego Aéreo (CTA)[16].

Estimadores

Filtro de Kalman para movimento uniforme;

Filtro de Kalman para manobra;

Filtro IMM de dois modos.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 33: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Exemplo

Descrição do problema

Figura 5: Rastreamento de aeronave.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 34: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Exemplo

Modelagem do CTA

Modelamento do CTA

Modos de operação de um avião civil

Movimento uniforme =⇒ linha reta com velocidade e cursoconstante.

Manobra =⇒ curva, subida ou descida.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 35: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Exemplo

Movimento Uniforme (MU)

Movimento Uniforme (MU)

Ruído branco de aceleração

x(k + 1) =

1 T 0 00 1 0 00 0 1 T0 0 0 1

x(k) +

12T 2 0T 00 1

2T 2

0 T

v(k)

z =

[

1 0 0 00 0 1 0

]

x(k) + w(k)

x = [ξ ξ η η]′

ξ e η são as coordenadas (posição) do plano cartesiano.vk ∼ N(0,Q) e wk ∼ N(0,R) são ruídos Gaussianosindependentes.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 36: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Exemplo

Modelo de Manobra

Modelo de Manobra

Coordinated turn

x(k + 1) =

1sin(Ω(k)T )

Ω(k)0 −

1−cos(Ω(k)T )

Ω(k)0

0 cos(Ω(k)T ) 0 − sin(Ω(k)T ) 0

01−cos(Ω(k)T )

Ω(k)1

sin(Ω(k)T )

Ω(k)0

0 sin(Ω(k)T ) 0 cos(Ω(k)T ) 00 0 0 0 1

x(k) +

12

T 2 0 0T 0 0

0 12

T 2 00 T 00 0 T

v(k)

z =

[

1 0 0 0 00 0 1 0 0

]

x(k) + w(k)

x = [ξ ξ η η Ω]′

ξ e η são as coordenadas (posição) do plano cartesiano.

Ω é a velocidade angular.

vk ∼ N(0,Q) e wk ∼ N(0, R) são ruídos Gaussianos independentes.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 37: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Exemplo

Linearização da função

Linearização da Função

Para velocidade angular não constante, torna-se necessário utilizaralguma técnica de filtragem não-linear, tendo sido escolhido oFiltro de Kalman Estendido (EKF).

EKF para o CT

x(k + 1) = f [k, x(k)] + GCT (k)v(k)

Expandindo a função f em uma série de Taylor em torno da últimaestimativa x(k|k) e tomando apenas o termo de primeira ordem,temos

x(k + 1) = f [k, x(k)] + fx (k)(x(k) − x(k|k)) + GCT (k)v(k)

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 38: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Exemplo

Linearização da função

em que

fx (k) =[

x f (k, x)′]′∣

x=x(k|k)

=

1sin(Ω(k)T )

Ω(k)0 −

1−cos(Ω(k)T )

Ω(k)fΩ,1(k)

0 cos(Ω(k)T ) 0 − sin(Ω(k)T ) fΩ,2(k)

01−cos(Ω(k)T )

Ω(k)1

sin(Ω(k)T )Ω(k)

fΩ,3(k)

0 sin(Ω(k)T ) 0 cos(Ω(k)T ) fΩ,4(k)0 0 0 0 1

[

fΩ,1(k)fΩ,2(k)fΩ,3(k)fΩ,4(k)

]

=

cos(Ω(k)T )T ξΩ(k)

−sin(Ω(k)T )ξ

Ω(k)2−

sin(Ω(k)T )T ηΩ(k)

−(−1+cos(Ω(k)T ))η

Ω(k)2

− sin(Ω(k)T )T ξ− cos(Ω(k)T )T ηsin(Ω(k)T )T ξ

Ω(k)−

(−1+cos(Ω(k)T ))ξ

Ω(k)2+

cos(Ω(k)T )T η

Ω(k)−

sin(Ω(k)T )η

Ω(k)2

cos(Ω(k)T )T ξ− cos(Ω(k)T )T η

obs: para Ω pequeno, usa-se limΩ→0(fx (k))

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 39: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Exemplo

Modelo EKF para CT final

Modelo EKF para CT final

Predição

x(k + 1|k) = f [k, x (k|k)]

P(k + 1|k) = fx (k)P(k|k)fx (k)′ + GCT Q(k)GCT ′′

Mistura de estados com diferentes dimensões

dim(MU) = 4 e dim(CT ) = 5 =⇒ problema na mistura doIMM;

Solução: aumenta o estado do modo que for usar o MU comomodelo.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 40: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Simulação

Escolha dos Parâmetros

Comentários

É bom que o ruído de processo do MU seja pequeno, maspode ser usado um pouco grande para modelar pequenascurvas e acelerações.

O ruído de processo do CT depende de quanto se espera develocidade angular e de quantos modelos serão usados.

A matriz de transição de probabilidade não influencia muito=⇒ probabilidades baseadas no tempo médio em cada modo.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 41: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Simulação

Simulação

Simulating. Please, wait.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 42: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Conclusões

Conclusões

Realizar a estimação linear ótima de sistemas com parâmetros Markovianos écomputacionalmente impraticável, visto que a quantidade de hipóteses é O(Nk).O estimador IMM tem custo aproximadamente linear com o número de modos,enquanto suas estimativas são comparáveis a de métodos de complexidade qua-drática;

Em aplicações práticas de filtragem com número de modos N = 2, o algoritmoIMM é a melhor primeira escolha [3];

A aproximação introduzida por (16) pode tornar o estimador IMM inadequadoem situações em que o número N de modos é grande. Nestes casos, deve-seconsiderar algoritmos de maior complexidade;

A escolha dentre múltiplos do método AMM é um caso particular do IMM;

Em geral, o Filtro de Kalman fornece estimativas inferiores às de um estimadorIMM adequadamente ajustado [16];

A capacidade do estimador IMM de detectar rapidamente transições entre modosdo sistema (manobras) torna-o uma boa escolha para situações de rastreamentode alvos [16];

Caso os múltiplos modelos estimados sejam semelhantes, o estimador IMM nãoé capaz distingui-los, tornando-o uma versão “disfarçada” do FK;

A revisão do estado da arte mostrou que a abordagem IMM pode ser aplicadaem muitos casos reais;

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 43: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Referências bibliográficas

[1] H.A.P. Blom.An efficient filter for abruptly changing systems.Proceeding of 23rd Conference on Decision and Control, 4(30):656–658, Dezembro 1984.

[2] E. Mazor, A. Averbuch, Y. Bar-Shalom, and J. Dayan.Interacting multiple model methods in target tracking: A survey.IEEE Transactions on Aerospace and Eletronic Systems, 34(1):103–123, Janeiro 1998.

[3] H.A.P. Blom and Y. Bar-Shalom.The interacting multiple model algorithm for systems with markovian switching coefficients.IEEE Transactions on Automatic Control, 33(8):780–783, Agosto 1988.

[4] X.R. Li and Y. Bar-Shalom.Performance prediction of the interacting multiple model algorithm.IEEE Transactions on Aerospace and Eletronic Systems, 29(3):755–771, Julho 1993.

[5] L.A. Johnston and V. Krishnamurthy.An improvement to the interacting multiple model (IMM) algorithm.IEEE Transactions on Signal Processing, 49(12):2909–2923, Dezembro 2001.

[6] T. Kirubarajan and Y. Bar-Shalom.Kalman filter versus imm estimator: When do we need the latter?IEEE Transactions on Aerospace and Eletronic Systems, 39(4):1452–1457, Outubro 2003.

[7] C.E. Seah and I. Hwang.Stability analysis of the interacting multiple model algorithm.American Control Conference, pages 2415–2420, Junho 2008.

[8] Y. Boers and J.N. Driessen.Interacting multiple model particle filter.IEE Proc.-Radar Sonar Navig., 150(5):344–349, Outubro 2003.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 44: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Referências bibliográficas

[9] J. Wang, D. Zhao, W. Gao, and S. Shan.Interacting multiple model particle filter to adaptive visual tracking.Proceedings of the Third International Conference on Image and Graphics, 2004.

[10] R. Guo, Z. Qin, X. Li, and J. Chen.Interacting multiple model particle-type filtering approaches to ground target tracking.Journal of Computers, 3(7):23–30, Julho 2008.

[11] C. Ramesh and V. Vaidehi.Imm based kalman filter for channel estimation in uwb ofdm systems.IEEE-ICSCN, pages 320–325, Fevereiro 2007.

[12] A. Houles and Y. Bar-Shalom.Multisensor tracking of a maneuvering target in clutter.IEEE Transactions on Aerospace and Eletronic Systems, AES-25(2):176–189, Março 1989.

[13] X.R. Li and Y. Bar-Shalom.Design of an interacting multiple model algorithm for air traffic control tracking.IEEE Transactions on Control Systems Technology, 1(3):186–194, Setembro 1993.

[14] M. Yeddanapudi, Y. Bar-Shalom, and K.R. Pattipati.Imm estimation for multitarget-multisensor air traffic surveillance.Proceedings of the IEEE, 85(1):80–94, Janeiro 1997.

[15] W. Schmaedeke and K. Kastella.Sensor management using discrimination gain and interacting multiple model kalman filters.Lockheed-Martin Tactical Defense Systems - Eagan, 1998.

[16] Y. Bar-Shalom, X.R. Li, and T. Kirubarajan.Estimation with Applications to Tracking and Navigation.John Wiley & Sons, 2001.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)

Page 45: Interacting Multiple Model Kalman ... - people.csail.mit.edupeople.csail.mit.edu/psantana/data/files/seminars/EFE_Menegaz... · 6 Simulação 7 Conclusões 8 Referências bibliográficas

Interacting Multiple Model Kalman Filters (IMMKF)

Referências bibliográficas

[17] I. Hwang, H. Balakrishnan, and C. Tomlin.State estimation for hybrid systems: applications to aircraft tracking.IEE Proc.-Control Theory Appl., 153(5):556–566, Setembro 2006.

[18] J. Burlet, O. Aycard, A. Spalanzani, and C. Laugier.Pedestrian tracking in car parks : an adaptive interacting multiple models based filtering method.Proceedings of the IEEE ITSC 2006, pages 462–467, Setembro 2006.

[19] J.B.B. Gomes.An Overview on Target Tracking Using Multiple Model Methods.PhD thesis, Universidade Técnica de Lisboa, 2008.

[20] M.E. Farmer, R.L. Hsu, and A.K. Jain.Interacting multiple model (imm) kalman filters for robust high speed human motion tracking.Preprint.

Henrique M. Menegaz, Pedro Henrique R.Q.A. Santana Interacting Multiple Model Kalman Filters (IMMKF)