rastreamento de trajetórias - apresentação final

32
12/11/07 PTC2530 - Projeto de Formatura 1 Rastreamento de trajetórias de robôs móveis Orientador: Prof. Dr. José Jaime da Cruz George Guimarães Jonathan Xavier Tatiana Ozeki

Upload: george-guimaraes

Post on 04-Jul-2015

1.146 views

Category:

Technology


2 download

DESCRIPTION

Apresentação final do trabalho de formatura.

TRANSCRIPT

Page 1: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 1

Rastreamento de trajetórias de robôs móveis

Orientador: Prof. Dr. José Jaime da Cruz

George GuimarãesJonathan Xavier

Tatiana Ozeki

Page 2: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 2

confiar em sensores?

Page 3: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 3

Problema: localização

Page 4: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 4

Objetivos

Estudar o problema de estimação de trajetórias de robôs móveis

Avaliar o efeito do número de sensores na estimação

Avaliar o desempenho da estimação utilizando o filtro de Kalman

Page 5: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 5

Referências Bibliográficas

Gelb, Arthur Applied Optimal Estimation

Hall, D.L. Llinas, J. An introduction to multisensor data fusion

Durrant-Whyte, Hugh Sensor Models and Multisensor Integration

Gutmann, J. S. et al. An experimental comparison of localization

methods

Page 6: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 6

Filtro de Kalman e Modelo do Sistema

Page 7: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 7

Aplicação do Algoritmo

(1) Calcular o ganho de Kalman

(2) Atualizar a estimativa com a medida zk

(3) Atualizar a covariância do erro

(1) Projetar o estado à frente

(2) Projetar a covariância do erro à frente

Atualização das Medidas (“Corretor”) Atualização do tempo (“Preditor”)

kkk BuxAx

1ˆˆ

QAAPP Tkk

1

1 RHHPHPK Tk

Tkk

kkkkk xHzKxx ˆˆˆ

kkk PHKIP

Estimativas iniciais

Page 8: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 8

Modelo do sistema

Page 9: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 9

Equações de Estado

1100

0100

0010

0001

A

pXx 1

pYx 2

3x

4x

,

11 )()( kkk wtAxtx

Page 10: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 10

Equações de Medidas

kkk vxhz )(

1635341 sincos)( vxYxxxxxh pik

2635342 cossin)( vxXxxxxxh pik

Onde piX e piY são as distâncias dos sensores ao eixo.

Page 11: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 11

Plataforma

Page 12: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 12

Page 13: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 13

Page 14: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 14

Page 15: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 15

Page 16: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 16

Desalinhamento dos eixos

Page 17: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 17

Software de medição

Page 18: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 18

Mouse reader

Page 19: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 19

Vetores

Page 20: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 20

Simulação

Page 21: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 21

Caso ideal

Page 22: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 22

Com erro de alinhamento

Page 23: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 23

Alinhamento corrigido

Page 24: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 24

Resultados Experimentais

Page 25: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 25

Page 26: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 26

Page 27: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 27

Page 28: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 28

Page 29: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 29

Page 30: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 30

Page 31: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 31

Conclusões

Filtro de Kalman: preditor poderoso Conhecimento do modelo é essencial Conhecimento dos sensores auxilia a

estimativa Aumento do número de sensores

melhora a estimativa Estimativa do ângulo é fraca

Page 32: Rastreamento de Trajetórias - Apresentação Final

12/11/07 PTC2530 - Projeto de Formatura 32Obrigado!

?