CARACTERIZAÇÃO DO SENSOR GPS E APLICAÇÃO EM BARCO AUTÔNOMO. Ivan Mota Moura Fé IC Elder Moreira Hemerly PQ

Transcrição

1 CARACTERIZAÇÃO DO SENSOR GPS E APLICAÇÃO EM BARCO AUTÔNOMO Ivan Mota Moura Fé IC Elder Moreira Hemerly PQ Resumo: Este trabalho teve por objetivo a implementação de um sistema de navegação para aplicação no barco, baseado nos sensores tipo bússola digital e GPS. Um programa desenvolvido em linguagem C coleta os dados do receptor Trimble, informando latitude e longitude. Abstract: This work aims at implementing a navigation system for use on a boat, based on GPS sensors and digital compass. A program designed in C programming language collects data from the Trimble receiver, returning latitude and longitude information. 1-INTRODUÇÃO Este projeto utiliza o barco autônomo que foi implementado pelos departamentos de Sistemas e Controle-IEES e Telecomunicações-IEET do ITA, cujo protótipo é mostrado na Figura 1, com o intuito de servir como plataforma de testes para estratégias de controle, instrumentação e processamento de sinais. Figura 1 Protótipo do barco a ser utilizado neste projeto Figura 2 Estrutura do barco O desenvolvimento completo deste projeto, de acordo com o objetivo inicial, pode ser descrito em quatro fases principais de trabalho: 1) Desenvolvimento de software, em linguagem C, para leitura do sensor GPS disponível no Departamento de Telecomunicações-IEET do ITA, com particular interesse nas informações de latitude e longitude. 2) Desenvolvimento de software para leitura da informação de uma bússola digital disponível no Departamento de Sistemas e Controle-IEES do ITA. 3) Implementação do sistema de navegação baseado em GPS+bússola digital no barco da Figura 1. Deverá ser efetuada uma mudança de coordenadas, do receptor GPS para um referencial no lago. 4) Realização de trabalhos experimentais para se avaliar o desempenho do sistema de navegação.

2 2 - GPS GPS (Global Positioning System) é a abreviatura de NAVSTAR GPS (NAVSTAR GPS-NAVigation System with Time And Ranging Global Positioning System). É um sistema de radionavegação baseado em satélites desenvolvido e controlado pelo departamento de defesa dos Estados Unidos da América, que permite a qualquer utilizador saber a sua localização, velocidade e tempo, 24 horas por dia, sob quaisquer condições atmosféricas e em qualquer ponto do globo terrestre. No processo de cálculo da posição pelo sensor GPS, temos que transformar as coordenadas obtidas com o receptor, que têm com referência o WGS-84 (World Geodetic System 1984), em coordenadas cartesianas, que podem ser, posteriormente transladadas e/ou giradas, usando-se uma simples transformação de referencial. WGS 84 é um referencial global fixado na terra, usado pelo sistema GPS desde Podemos expressar uma posição qualquer na Terra usando coordenadas cartesianas ou coordenadas elipsoidais, que é o caso do WGS-84. As coordenadas retangulares também são freqüentemente chamadas de coordenadas ECEF (Earth-Centered-Earth-Fixed), isto é, coordenadas centradas e fixadas na terra. As relações entre estes referenciais são: X = (N + h).cosϕ.cosλ Y = (N + h).cosϕ.senλ Z = [(b 2 /a 2 ).N + h].sinϕ Raio da elipsóide: N = a 2 /(a 2 cos 2 ϕ + b 2 sinϕ) 1/2 Figura 3 Coordenadas cartesianas e coordenadas elipsoidais. 2 ESTRUTURA DO BARCO A figura 2 fornece as dimensões físicas e a estrutura do barco. O sistema de propulsão do barco é constituído por duas hélices acionadas por motores. Os motores utilizados para propulsão são motores O.S. MAX 46 FX (motor a explosão de dois tempos). A cada um dos motores foi conectado um servoposicionador FUTABA S3003 (que controla a abertura da válvula de entrada de ar), que recebe comandos do computador de bordo, modulados em PWM por um circuito específico. O aumento da abertura provoca um aumento da potência desenvolvida, aumentando também o empuxo fornecido por cada hélice. Foi adotado como computador de bordo, por questões de custo e simplicidade, um micro IBM-PC 486DX4 100, que possui as funções de coleta de dados, controle e gerenciamento das atividades de comunicação. A alimentação do micro é provida por um no-break, acoplado na parte de baixo da tábua de fixação do computador. O no-break confere ao sistema uma autonomia de aproximadamente 20 minutos e fornece energia elétrica durante os ensaios de campo. A estrutura do barco contém, em outra tábua, dois spoilers que fazem o barco realizar curvas para a direita ou esquerda, bem como seu circuito de controle e interfaceamento com o computador de bordo. As curvas também podem ser realizadas por diferença nos empuxos do motor direito e do esquerdo. O leme é acionado por um motor DC controlado por um circuito que recebe comandos do computador de bordo.

3 A integração de sensores, atuadores e software de controle resulta em uma malha de controle multivariável. Os comandos podem ser pré-programados, de modo a fazer com que o barco siga uma trajetória especificada, ou transmitidos por um operador em terra através do enlace de RF. Um esquema de interfaceamento dos diferentes sub-sistemas com o computador de bordo encontra-se nas figura 4 e 5. Figura 4 Dispositivos de I/O utilizados pelo computador de bordo. Figura 5 Sensores e atuadores do sistema. 4 COLETA DE DADOS Para realizar a coleta de dados, utilizamos um receptor Trimble, um computador e um compilador de linguagem C/C++ (pertencentes à Divisão de Engenharia Eletrônica do ITA). O receptor Trimble utilizado fornece vários tipos de saídas de dados. Foi escolhida uma saída de dados que fornece a latitude e a longitude do veículo a cada segundo. O formato de saída de dados foi enviado à porta 2 do receptor, ligada à porta COM 2 do microcomputador utilizado no laboratório. O programa reconhece estes dados para coletar a informação desejada. Para isso, é necessário que o programa reconheça o cabeçalho $PTNL,PJ1 e, conhecendo o padrão de envio de dados, colete a latitude e longitude procuradas. O trecho de código-fonte abaixo ilustra como ocorre a recepção de dados. /**********recepção de dados via COM 2**************************************/ do outp (0x2fc, 0x02); do a = inp (0x2fd); while((a&0x01)==0); outp(0x2fc, 0); c = inp(0x2f8); s[0] = c; /**********verificação do protocolo******************************************/ if (c == char('$')) for( i =1; i < 8 ; i++) outp (0x2fc, 0x02); do a = inp (0x2fd); while((a&0x01) == 0); outp (0x2fc, 0); s[i] = inp (0x2f8); if (strcmp(s,"$ptnl,pj1"))

4 /**********execução da rotina de coleta de dados********************************/ ProcPTNLPJ1(); av = 1; printf("gpslat = %s,%c gpslong = %s,%c",gpslat,latsense,gpslong,longsense); while(!av); Os dados seguintes são uma amostra dos dados que foram coletados utilizando o receptor. Como se pode verificar, a saída do software imprime na tela os valores de longitude e latitude a cada segundo. Esses dados foram coletados no laboratório de Navegação por Satélite do Departamento de Telecomunicações-IEET do ITA. Não foi ligado nenhum módulo do receptor no barco. Nesse caso, em um intervalo de tempo significativo, veríamos as leves diferenças de latitude e longitude ao longo do percurso do barco, nos permitindo determinar sua trajetória aproximada, após a conversão do sistema de coordenadas para o referencial no lago. Aqui, percebemos a constância dessas duas medidas. $PTNL,PJ0, Time, 05AUG02, 18:06:34.000, , 178, 01.7, , $PTNL,PJ1, Raw, WGS84, 023:12'33.05",S, 045:52'30.59",W, , SPH $PTNL,PJ2, Datum, WGS84, 023:12'33.05",S, 045:52'30.59",W, , SPH $PTNL,PJ0, Time, 05AUG02, 18:06:35.000, , 178, 01.7, , $PTNL,PJ1, Raw, WGS84, 023:12'33.05",S, 045:52'30.59",W, , SPH $PTNL,PJ2, Datum, WGS84, 023:12'33.05",S, 045:52'30.59",W, , SPH $PTNL,PJ0, Time, 05AUG02, 18:06:36.000, , 178, 01.7, , $PTNL,PJ1, Raw, WGS84, 023:12'33.05",S, 045:52'30.59",W, , SPH $PTNL,PJ2, Datum, WGS84, 023:12'33.05",S, 045:52'30.59",W, , SPH $PTNL,PJ0, Time, 05AUG02, 18:06:37.000, , 178, 01.7, , $PTNL,PJ1, Raw, WGS84, 023:12'33.05",S, 045:52'30.59",W, , SPH $PTNL,PJ2, Datum, WGS84, 023:12'33.05",S, 045:52'30.59",W, , SPH 5 - CONCLUSÃO A continuação do projeto deverá ter como próximo passo o desenvolvimento de software para leitura da informação de uma bússola digital, disponível no Departamento de Sistemas e Controle-IEES do ITA, para posterior implementação do sistema de navegação baseado em GPS+bússola digital no barco. O trabalho desenvolvido ao longo dos meses pôde proporcionar a familiarização com o sensor GPS, bem como a verificação da saída de dados do software de leitura dos dados do sensor GPS. Nosso ambiente externo de trabalho é o lago próximo ao prédio da Engenharia Eletrônica ITA Não chegaram a ser realizadas medidas experimentais no lago, porém foi possível a familiarização com a estrutura do barco, no segundo semestre de 2001, com o auxílio do estudante André Rodrigues Parolo. 6 - REFERÊNCIAS BIBLIOGRÁFICAS [1] Jay Farrel e Matthew Barth, The Global Positioning System and Inertial Navigation [2] University of California, Engineering and Physical Sciences Extension Series, Inertial Guidance [3] PAROLO, André Rodrigues, Modelagem e Controle de um Barco Autônomo, 2001

5 CONTROLE FUZZY PARA BRAÇO ROBÓTICO UTILIZANDO A ABORDAGEM ADAPTATIVA NEURO-FUZZY (ANFIS) DO MATLAB João Rodolfo Côrtes Pires (PG) Divisão de Engenharia Mecânica-Aeronáutica Instituto Tecnológico de Aeronáutica São José dos Campos-SP jrcortes@mec.ita.br Cairo Lúcio Nascimento Júnior (PQ) Divisão de Engenharia Eletrônica Instituto Tecnológico de Aeronáutica São José dos Campos-SP cairo@ita.br RESUMO Em muitos casos a lógica fuzzy tipo Mamdani possibilita o rápido desenvolvimento de um controlador para um sistema físico mesmo se o projetista não dispor de um rigoroso modelo matemático do sistema a ser controlado. Variáveis lingüísticas são então usadas para modelar o conhecimento intuitivo dos operadores do sistema e assim desenvolver regras fuzzy tipo Mamdani que rapidamente produzirão um controle grosseiro. Entretanto, se for desejado um controlador de alto desempenho, os controladores fuzzy tipo Mamdani são difíceis de serem ajustados. Uma alternativa é o desenvolvimento de controladores fuzzy tipo Sugeno. Porém controladores desse tipo são de difícil ajuste manual visto que a topologia usada por este estilo de lógica fuzzy favorece o modelamento matemático em prejuízo da utilização do conhecimento intuitivo. Este artigo propõe a combinação do uso destes dois tipos de controladores fuzzy usando a estrutura de controle conhecida por feedbackerror-learning. Nesta estrutura um controlador fuzzy tipo Mamdani é rapidamente ajustado para implementar um controlador feedback estável mas de baixo desempenho. Então os parâmetros de um controlador fuzzy tipo Sugeno, funcionando como controlador feedforward, são ajustados por uma rotina de treinamento para sistemas neuro-fuzzy do software MATLAB (ANFIS Adaptive Neuro- Fuzzy Inference System). As simulações computacionais desta abordagem mostraram que para um braço robótico foi possível o rápido desenvolvimento de um sistema de controle com desempenho superior ao obtido quando apenas um dos dois tipos de controladores foi usado. ABSTRACT In many cases, by using the Mamdani-style fuzzy logic, a designer can rapidly develop a controller for a physical system even if a rigorous mathematical model of the system is not available. Linguistic variables and Mamdani-style fuzzy logic are then used to model the intuitive knowledge about the system, which was acquired by the operators through their everyday experience with the real-world system. In this way a rough controller can be rapidly obtained. However, if a high-performance controller is desired, experience has shown that it will be difficult to fine tune the Mamdani-style fuzzy controller manually or by using a training algoritthm. A possible alternative is to develop a Sugenostyle fuzzy controller which are hard to be adjusted manually since their topology favours mathematical modelling instead of the expression of intuitive knowledge. Sugeno-style fuzzy controller can be adjusted automatically by a training algorithm but it may be difficult to initialize the parameters of such a controller to obtain a stable learning process. This article proposes to combine the Mandani and Sugeno fuzzy controllers using the control structure known as Feedback-Error- Learning. Initially, only the Mandani-style fuzzy controller is used as the feedback controller and is rapidly tuned which to produce a rough stable controller. Then a Sugeno-style controller is used as a feedforward controller and is tuned by a neuro-fuzzy training algorithm available in the software package MATLAB (ANFIS - Adaptive Neuro-Fuzzy Inference System). Computer simulations of a highly non-linear robotic arm demonstrate that by using the proposed approach, when the two types of fuzzy controllers are used simultaneously, one could more rapidly develop a better controller than using either one of these two types of fuzzy controllers. 1. INTRODUÇAO Um sistema de controle tem como função fornecer respostas a uma determinada entrada de acordo com sua função de transferência. Para muitos sistemas esta função apresenta grande complexidade o que dificulta o controle através dos procedimentos convencionais. Nestes caso os