The Autonomous Boat Project

Apresentação em tema: "The Autonomous Boat Project"— Transcrição da apresentação:

1 The Autonomous Boat Project

2 The Autonomous Boat Project

3 The Autonomous Boat Project

4 Boat Controller

5 Inertial Measurement Unit (IMU)

6 Inertial Navigation Contudo: Deriva: posição e atitude

7 Real IMU

8 GPS Receptor

9 ITA – INSTITUTO TECNOLÓGICO DE AERONÁUTICA PÓS-GRADUAÇÃO EM ENGENHARIA ELETRÔNICA E COMPUTAÇÃO ÁREA DE DISPOSITIVOS E SISTEMAS ELETRÔNICOS PROJETO E CONSTRUÇÃO DE UM BARCO INTELIGENTE COM INTEGRAÇÃO INS/GPS E BÚSSOLA Douglas Soares dos Santos Orientadores: Prof. Wagner Chiepa Cunha Prof. Cairo L. Nascimento Jr. Boa tarde, agradeço a presença de todos.

10 Sumário Navegação Inercial Fusão sensorial Aprendizado por reforço
O barco inteligente Implementação da solução Resultados Conclusão Trabalhos Futuros Tópicos:

11 Introdução Motivação: Navegação Autônoma Máquinas Inteligentes
Retirar o ser humano da camada de operação e colocá-lo na camada de supervisão Objetivo: Projetar e construir um barco inteligente com integração INS/GPS e Bússola para navegação autônoma Capacidade de aprendizado

12 Sensor Fusion

13 O Barco Inteligente Para implementar o Barco Inteligente foram necessários os seguintes passos: Construção da estrutura do barco; Levantamento do modelo matemático do barco; Simulação do Sistema de Navegação Inercial (fusão usando FK); Simulação do aprendizado na tabela de acionamento dos propulsores; Implementação do módulo embarcado; Implementação da estação de controle do barco.

14 Fusão INS/GPS e Bússola
No caso do barco foram feitas duas considerações importantes: Navegação do barco em baixas velocidades; Navegação em águas calmas e sem ventos. Essas considerações permitem: Amostragem dos sinais em baixa frequência (1 Hz); Implementação em 3 graus de liberdade. Sensores embarcados no barco: IMU: Acelerômetros em X e Y; Girômetro em Z; Magnetômetros em X e Y. Receptor GPS (Lat/Long).

15 Sensor Fusion: INS/GPS + Compass

16 Boat Electronics

17 Sensor Fusion: INS/GPS/Compass

18 Sensor Fusion: INS/GPS/Compass

19 Sensor Fusion: INS/GPS/Compass
Definindo: E assumindo que: - para , - e = 0

20 Sensor Fusion: INS/GPS/Compass
Então: e: onde: e:

21 Kalman Filter Implementation
Step 1: Initialization

22 Kalman Filter Implementation
Step 2: Propagation of the INS state and its covariance matrix Read IMU: Calculate:

23 Kalman Filter Implementation
Step 3: INS update Calculate:

24 Kalman Filter Implementation
Calculate:

25 Fusão INS/GPS e Bússola (3D)

26 Boat Mathematical Model

27 Parâmetros m = massa do barco = 14,81kg
J = momento de inércia = 3,33 kg m² Constantes de arrasto: Kx = 7,025 Ns²/m², Ky = Kz = 5 Kx = 35,12 Ns²/m² d = distância medida entre o CG e os propulsores = 0,56 m Valores máximos de Fd e Fe = 1,4 N

28 Acionamento dos Propulsores
Manobra Motor esquerdo Motor direito Para frente LF Frente direita D Frente esquerda Para trás LT Trás direita Trás esquerda Gira esquerda Gira direita Parado

29 Boat Controller

30 Actuators Possible Actions:
M1 = left DC motor; M2 = right DC motor Possible Actions: 1= turn forward, 0 = turn off; -1 = turn backward

31 Control Table

32 Learning Control Actions
Serve bem no caso do barco; construir a estrutura do conhecimento

33 Learning Automata (LA) Algorithm
where: i = iteration number; k = step for iteration i; h = learning rate.

34 Learning Automata (LA) Algorithm

35 Learning Simulation New Control Table

36 Boat Simulation

37 Módulo Embarcado

38 Estação de Controle

39 Comparison: Simulated and Real Systems
Simulated System Real System

40 Results

41 Control Station

42 Vídeo do Barco Vídeo do resultado da navegação autônoma do barco no lago do ITA

43 Control Station Vídeo que mostra a dinâmica da tela da estação de controle

44 Loss of GPS Signal (Real Case)

45 Loss of GPS Signal (Real Case)

46 Conclusão Um barco inteligente com integração INS/GPS e Bússola foi projetado e construído. O correto funcionamento do barco foi demonstrado pelos experimentos. O objetivo proposto nesse trabalho foi alcançado. Principais contribuições científicas do trabalho: Estrutura mecânica da plataforma do barco. Aplicação do algoritmo de aprendizado por reforço LA para geração da tabela de acionamento do barco, Formulação de um algoritmo de integração INS/GPS e Bússola usando Filtro de Kalman para a navegação 3D.

47 Trabalhos Futuros Aplicação em ITS (Intelligent Transportation Systems) visando o desenvolvimento de veículos terrestres inteligentes. Investigar a fusão sensorial com outros tipos de sensores, p. ex., câmeras, GPS indoor, odômetros e rádio-orientação. Desenvolvimento de solução totalmente embarcada (solução para perda do link de comunicação). Investigar a necessidade da extensão para o caso 6D para veículos terrestres. Implementação de algoritmo de sintonia ótima da matriz Qd do Filtro de Kalman (combate à divergência do FK). Investigar o algoritmo de aprendizado onde o número e o tamanho das partições é auto-ajustável. Investigar aplicações industriais e em sistemas de vigilância.

48 Agradecimentos Ao Projeto de Capacitação Tecnológica e Formação de Recursos Humanos para o Setor Aeronáutico (CAPTAER), pelos equipamentos e instrumentos adquiridos e utilizados neste trabalho. Estimação adaptativa dos erros de estado; IMU n giroscópica: mestrado Edmundo… Prof. Hélio Kuga

49 Módulo Embarcado

50 Estação de Controle

51 Deriva dos Acelerômetros e Girômetro