Escolar Documentos
Profissional Documentos
Cultura Documentos
PE !
!
u Interface DP/ROV
Manual
Figura 2: Vista esquematica do braco mec^anico passivo
D/A
p p p Auto
-
Joystick PC proposto.
486DX
50Mhz
Console
do ROV
h
h
h
h
h
h
h
h
Watchdog 2.3 Sistema de aquisic~ao de dados
Nos testes previstos com o ROV Tatu em tanque
6
Rele
de provas a regi~ao de operac~ao era relativamente pe-
quena. Assim, decidiu{se transmitir os sinais dos po-
6
? - Condicion. - A/D tenci^ometros do BMP ao sistema de aquisic~ao de dados
de sinais atraves de um cabo de 40 m xado ao longo do umbilical
do ROV.
b
h Sistema de aquisic~ao de dados
O tratamento analogico de sinais e realizado pelo
q Bra co
Passivo
6
q Estrutura condicionador CS02 que permite compensar a queda
ROV H
Submersa de tens~ao nos cabos longos, aumentar a imunidade a
q
H
H
H
H
H
H
rudos eletromagneticos e reduzir o aliasing causado pela
H
2
entre dois conectores da unidade de comando; (iii) as de um ROV, foram estabelecidos alguns criterios e res-
chaves permitem comutar o modo de comando para man- tric~oes a serem observados no projeto do DP, a saber [6]
ual a qualquer tempo, o que e importante para se guiar [11]: (i) a resposta din^amica de cada coordenada contro-
o ROV ate o local de operac~ao e na eventualidade do lada diretamente deve ter um mnimo de sobrepasso para
mau funcionamento do DP. evitar choques indesejaveis com obstaculos; (ii) o erro
Para tornar mais segura a operac~ao do DP, foi includo de regime das coordenadas controladas deve ser man-
nesta interface um circuito de watchdog que comuta au- tido dentro da menor toler^ancia possvel, mesmo quando
tomaticamente o modo de comando para manual atraves o ROV estiver sob in
u^encia de perturbac~oes; (iii) a
de um rele no caso do funcionamento anormal do micro- mudanca de rumo ou de posic~ao deve excitar pouco os
computador em que esta implementado o DP. graus de liberdade n~ao controlados diretamente (^angulos
Futuramente, seria interessante incluir nesta interface de arfagem e de jogo), porque o balanco excessivo do
as seguintes caractersticas: (i) isolamento otico entre ROV diculta sua operac~ao; (iv) o tempo de resposta
a unidade de comando do ROV e o microcomputador aos comandos do operador e a durac~ao de transitorios
para reduzir problemas com rudos eletricos e a diferenca causados por perturbac~oes devem ser pequenos; (v) os
de potencial entre os aterramentos; (ii) ler os sinais do ciclos{limite (caso ocorram) devem ter a menor ampli-
joystick da unidade de comando atraves de canais A/D tude possvel.
para permitir a comutac~ao via software entre o modo Dentre as diversas propostas para o controle de ROV's,
manual e o modo automatico; (iii) compatibiliza{la com destacam{se: controle convencional; controle a estru-
ROV's de diversos fabricantes. tura variavel [12]; controle adaptativo baseado em iden-
ticac~ao ou na formulac~ao de mnima vari^ancia [1] [13];
3 Din^amica do ROV controle robusto [14]; controle adaptativo por modelo de
refer^encia e estrutura variavel [15] [16] [11].
Os ROV's possuem uma din^amica n~ao{linear bastante Neste projeto escolheu{se utilizar um sistema de con-
complexa e com forte acoplamento entre os seus graus trole semelhante aos atualmente empregados em em-
de liberdade. Isto diculta signicativamente o projeto barcac~oes com DP (vide [17]). Neste caso, cada coorde-
de sistemas de controle. Felizmente, se as velocidades de nada de interesse e controlada por um PID. Nesta linha,
translac~ao e de rotac~ao do ROV (absolutas e em relac~ao o controle convencional (linear) de ROV's e uma alterna-
a agua) forem sucientemente pequenas e denindo{se tiva viavel, conforme sugerido em varios trabalhos (e.g.,
que a posic~ao do ROV e a posic~ao de seu centro de [18] [10]), sendo algumas das suas principais vantagens:
massa [10] [11], o arraste e outros termos das equac~oes simplicidade de implementac~ao; familiaridade dos en-
din^amicas do ROV podem ser desprezados. Este e jus- genheiros e especialistas em controle com a sua estru-
tamente o caso da regulac~ao de posic~ao que e o objetivo tura e ajuste; facilidade de projeto e possibilidade de
do DPSROV. Ent~ao, uma vez que o veculo esteja na sintonia in loco.
vizinhanca do regime estacionario, a din^amica de cada Assim sendo, com a experi^encia adquirida em trabalhos
grau de liberdade pode ser modelada aproximadamente anteriores [10] [15] [6] [11], selecionou{se o controlador
como um duplo integrador: P-PI. A Figura 3 mostra o diagrama de blocos deste
q = K [u(t T ) + d(t)] (1) controlador aplicado a um grau de liberdade generico.
onde: q e uma coordenada generica; u e o sinal de con- R
trole (sinal de entrada do joystick normalizado na faixa vmax
- KI -
provocadas pelo arraste e pelo cabo umbilical, isto e,
tambem e uma func~ao do estado do ROV. No projeto Figura 3: Diagrama de blocos do controlador P-PI de
dos controladores assume{se que esta perturbac~ao n~ao um grau de liberdade incluindo a estrategia ARW.
pode ser medida devido a limitac~oes tecnicas. Deve{se notar que neste artigo o controlador e descrito
Conforme desenvolvimento realizado em [11] o ganho na sua vers~ao em tempo contnuo. No entanto, na im-
pode ser dado genericamente por: plementac~ao em computador digital os algoritmos foram
K = f=m (2) discretizados pela aproximac~ao Forward dierence [19].
onde: f e a relac~ao entre a forca generalizada produzida
pelos propulsores que atua diretamente no grau de liber- 4.1 Sintonia do controlador
dade especicado e o sinal de comando u e m e a massa O ajuste dos ganhos deste controlador baseia{se no posi-
generalizada do grau de liberdade. Pode{se assumir que cionamento de polos, os quais, no entanto, n~ao podem
f e constante se a unidade de comando do ROV com- ser arbitrariamente escolhidos (o que possibilitaria que
pensar a n~ao{linearidade inerente aos propulsores. a resposta din^amica fosse arbitrariamente rapida) de-
vido as diversas simplicac~oes adotadas no modelo da
4 Algoritmo de controle din^amica de um grau de liberdade do ROV (e.g., propul-
sor modelado pela sua resposta estatica). Por isso,
O objetivo basico do DP e levar e manter o ROV numa adotou{se aqui a realizac~ao do ajuste dos ganhos em
posic~ao xa especicada. Baseado nas func~oes usuais duas etapas [10]. Na primeira etapa ajusta{se a malha
3
de controle de velocidade (malha interna) e em seguida a ac~ao integral evitando, assim, que o estado do inte-
ajusta{se a malha de controle de posic~ao (malha ex- grador ultrapasse a faixa [-1,1].
terna).
Para se fazer o ajuste da malha interna, abre{se a malha 4.3 Convers~ao de coordenadas
externa e calculam{se os ganhos Kp1 e KI de forma que Os sinais de comando (u) s~ao forcas e momentos repre-
o polo seja duplo e localizado em a = cb, onde b e o polo sentados no sistema de coordenadas xo ao ROV (sis-
dominante do P-PI e c > 1 e uma constante. A partir tema movel). Por outro lado, a posic~ao do ROV e
da equac~ao caracterstica da malha interna medida no sistema de coordenadas inercial. Portanto,
s2 + K Kp1 s + K KI = 0 (3) para permitir o seu controle e necessario realizar uma
convers~ao de coordenadas apropriada. Existem diversas
obtida do modelo (1) com as simplicac~oes T = 0 e formas de realizar esta convers~ao. Selecionou{se a es-
d(t) 0, desenvolvem{se as seguintes express~oes para trategia denominada convers~ao do erro de posica~o [11],
o calculo desses ganhos: que tambem foi adotada em [12], [1] e [13].
Kp1 = 2cb=K (4) Nesta estrategia o erro de posic~ao e a velocidade de
KI = c b =K
2 2
(5) translac~ao (calculados no sistema inercial) s~ao conver-
O ajuste da malha externa e realizado de forma que a tidos para o sistema movel, enquanto que os sinais de
equac~ao caracterstica da din^amica de um grau de liber- comando permanecem representados no sitema xo ao
dade com as duas malhas fechadas, dada por ROV. Neste caso, os sinais de erro s~ao calculados pelas
seguintes express~oes:
s3 2cbs2 + (c2 b2 2cbKp2 )s + c2 b2 Kp2 = 0 (6) ex = (xref xe) cos + (yref ye) sin (8)
ey = (xref xe ) sin + (yref ye ) cos (9)
tenha uma raz localizada em b (polo dominante). Para ez = zref ze (10)
isso, o ganho Kp2 e calculado pela seguinte express~ao: e = ref (11)
Kp2 = b(2c c2 1)=[c(c 2)] (7)
onde: xe e ye s~ao as coordenadas de posic~ao do ROV
Na segunda etapa, como os polos n~ao podem ser posi- no plano horizontal (em coordenadas inerciais); ze e a
cionados arbitrariamente, ha a necessidade de validar profundidade do ROV; e o ^angulo de rumo do ROV;
o projeto ou por simulac~ao ou atraves de experimentos ref e um subscrito que denota sinal de refer^encia e eq e
com o ROV real. O algoritmo iterativo de sintonia do o erro de posic~ao representado no sistema movel (q = x,
P-PI e descrito a seguir. y, z , ):
O controlador de cada grau de liberdade e sintonizado
independentemente, um de cada vez. Para a sintonia de 4.4 Estimador de velocidade
cada controlador foram realizadas diversas simulac~oes Para implementar o controlador P-PI s~ao necessarias as
em que os ganhos foram calculados por (4), (5) e (7) velocidades de translac~ao e de rotac~ao do ROV (gene-
(adotou{se c = 3, que e um valor que se mostrou satis- ricamente representadas por q_), que n~ao s~ao fornecidas
fatorio). A condic~ao inicial adotada em cada simulac~ao diretamente pelo BMP. E possvel medir{se a velocidade
e escolhida de forma a excitar predominantemante o atraves da inclus~ao de transdutores especcos (e.g., u-
movimento do grau de liberdade correspondente ao con- sando o efeito Doppler) no sistema de medic~ao. No en-
trolador a ser sintonizado. Em cada caso as demais tanto haveria uma elevac~ao desnecessaria de custo, uma
condic~oes iniciais s~ao nulas. vez que, neste caso, a velocidade pode ser estimada a
Cada controlador e sintonizado de forma iterativa, que partir da posic~ao medida.
comeca com uma grande constante de tempo (1=jbj), que Para estimar a velocidade utilizou{se uma soluc~ao
e reduzida passo a passo em simulac~oes sucessivas. O can^onica que ja mostrou bons resultados [11] e que con-
processo iterativo e nalizado de acordo com os criterios siste em um derivador com um ltro passa baixas de
(i)-(v). primeira ordem. O ltro possibilita a realizac~ao do
Este algoritmo de sintonia possibilita que cada contro- derivador e atenua o rudo de alta frequ^encia existente
lador seja otimizado de forma a aproveitar a assimetria na medida de posic~ao. Cada componente da velocidade
do ROV. Isso e evidenciado em simulac~oes [11] nas quais e estimada no sistema de coordenadas inercial por um
o movimento do ROV para vante e mais rapido que o ltro lead com a seguinte func~ao de transfer^encia:
seu movimento lateral, por exemplo. Gf (s) = s s+ 1 (12)
4.2 Estrategia antireset windup (ARW) !c
onde !c e a frequ^encia de corte do ltro (em rad=s).
Conforme proposto em [18], deve{se saturar a refer^encia Deve{se incluir uma convers~ao apropriada de coorde-
de velocidade da malha interna (u1 ), para limitar a nadas (cf. sec~ao 4.3) para converter as componentes
maxima velocidade de deslocamento do ROV (vmax ) horizontais da velocidade de translac~ao (estimadas no
quando o operador solicita movimentos amplos. O ob- sistema de coordenadas inercial) para o sistema de coor-
jetivo disto e melhorar o desempenho do controlador re- denadas movel.
speitando os limites de velocidade do ROV. Um inconveniente deste estimador e que sua inclus~ao na
Alem disso, deve{se adotar uma estrategia ARW para malha de controle modica o comportamento din^amico
evitar problemas com a saturac~ao dos propulsores [19]. e pode, inclusive, instabilizar o DP. Para que essa al-
Neste controlador escolheu{se limitar a sua sada e parar terac~ao seja pequena, a frequ^encia de corte !c deve ser
4
sucientemente alta, o que aproxima os estimadores de do BMP a estrutura submarina (este eixo e uma regi~ao
diferenciadores. No entanto, deve{se procurar um valor singular da cinematica do BMP). Caso qualquer destas
de compromisso para !c a m de reduzir a oscilac~ao da variaveis ultrapasse os seus respectivos limites, ser~ao
posic~ao e do sinal de comando causada pelo rudo de acionados dois alarmes, um visual e outro sonoro. O
medic~ao. alarme sonoro cessa assim que sua causa desapareca. O
Para suavizar o rudo de medic~ao introduz{se uma pre{ alarme visual exige o reconhecimento via teclado, facili-
ltragem do tipo media movel, aproveitando o fato de tando a identicac~ao da causa.
que a aquisic~ao das medidas dos ^angulos das juntas do Outra func~ao basica deste modulo e tratar os erros gera-
BMP pode ser feita numa frequ^encia maior (300 Hz ) que dos pelo DOS para evitar que a execuc~ao do programa
a adotada para o controle (10 Hz ) [20]. Desta forma, seja interrompida.
dentro da janela de tempo de um intervalo de controle,
calcula{se a media aritmetica das medidas aquisitadas
nesta janela. Os valores medios dos ^angulos das jun-
5.4 Biblioteca de classes
tas e que s~ao utilizados no calculo da posic~ao (linear e Para o desenvolvimento do DPROV foram denidos tr^es
angular) e dos sinais de controle. Assim, na Figura 3, objetos basicos:
os sinais q e q_ representam na realidade sinais medios GRAU LIBERDADE: descreve cada grau de liber-
obtidos pela pre{ltragem descrita acima. dade do ROV (x, y, z , rumo, arfagem e jogo). Este
objeto especica para cada grau de liberdade o tipo
5 Software do DP de controle e estimador de velocidade ativados, as suas
variaveis e a refer^encia de posic~ao correspondente.
O software do DP (DPROV) foi desenvolvido con- LINK: e a descric~ao de cada elo (movel ou n~ao) do
forme detalhado em [21]. Este software integra as BMP. Cont^em a correspond^encia entre o numero do
seguintes func~oes: (i) medic~ao de posic~ao; (ii) controle canal do A/D e a junta movel, o seu fator de escala
de posic~ao; (iii) supervis~ao e seguranca; (iv) auxlio a e o{set, a faixa permitida de rotac~ao da junta.
avaliac~ao do desempenho do DP.
O DPROV foi desenvolvido sob o ambiente DOS em
ROV: este objeto agrupa os dois anteriores e ainda
C++. A estrutura do software e constituda de tr^es sub- acrescenta a matriz de transformac~ao da cinematica di-
sistemas: a interface Homem-Maquina (H/M), a rotina reta do BMP. Possui ainda semaforos que indicam se
um experimento esta sendo gravado em disco ou se o
de interrupc~ao e controle e o modulo de supervis~ao. A controle automatico esta ativado.
interface H/M foi feita em menus pop{up multijanelas
para facilitar a interac~ao com o usuario. A seguir cada
subsistema e descrito brevemente. 6 Resultados experimentais
5.1 Interface H/M Antes de se passar a fase experimental deste projeto,
os controladores foram testados com um simulador de
Este modulo gerencia a entrada de dados pelo teclado e ROV's que representa seus seis graus de liberdade [15]
a exibic~ao de dados numericos e gracos em tempo real [16] [11] [23]). A utilizac~ao do simulador auxiliou a
ou o{line. Esta interface oferece, ainda, as seguintes avaliac~ao do desempenho e a identicac~ao e correc~ao de
facilidades: alterar os par^ametros dos controladores e diversos problemas nas estrategias de controle.
as frequ^encias de controle e de amostragem; armazenar Os testes em tanque foram realizados com o ROV Tatu
e/ou ler de disco a congurac~ao do programa e os da- construdo pela CONSUB/Rio de Janeiro.
dos de um experimento; apresentar alarmes indicando
condic~oes anormais de operac~ao. A Figura 4 mostra o desempenho do DP em tanque de
provas. Verica{se que o DPSROV mant^em a posic~ao
5.2 Rotina de interrupc~ao e controle numa bola de cerca de 5 cm de raio, o que foi estabe-
lecido como objetivo inicial do projeto para que o DP
Esta rotina e ativada periodicamente por interrupc~oes possa facilitar a operac~ao de ROV's. Os ciclos{limite in-
disparadas por um temporizador programavel. Sua desejaveis que s~ao observados ja estavam previstos em
principal func~ao e fazer a aquisic~ao dos ^angulos das jun- simulac~oes [11] [3] [23] nas quais identicou{se que s~ao
tas do BMP e armazena{los em um buer alocado di- causados pelo efeito combinado da din^amica dos propul-
namicamente. Apos esta aquisic~ao, os ^angulos s~ao pro- sores e do rudo de medic~ao (n~ao modelados no projeto
cessados por um ltro de media movel. Para gerar o dos controladores).
controle numa frequ^encia de amostragem menor utiliza{ Outro fator que contribuiu para a ocorr^encia de ciclos{
se o downsampling [22]. limite e o retardo no processamento do sinal do joy-
stick pela unidade de comando. Estimou{se experimen-
5.3 Modulo de supervis~ao talmente que todos os retardos no Tatu somados re-
Este modulo auxilia o operador a manter o ROV dentro sultam em T 1 s em (1). Portanto este retardo
de uma regi~ao de operac~ao de modo a n~ao danicar o deveria ser considerado na sintonia dos controladores,
BMP. Esta regi~ao de operac~ao e denida pelos seguintes pois e da ordem de grandeza do tempo de resposta em
limites: ^angulos maximos de rotac~ao de cada junta do malha fechada. Acredita{se que em outros ROV's este
BMP; raio maximo de excurs~ao do ROV (para evitar retardo seja bem menor, o que justicaria despreza{lo.
que o BMP opere esticado); dist^ancia mnima entre o As diversas imperfeic~oes cometidas na modelagem obri-
ROV e o eixo vertical que passa pelo ponto de xac~ao garam a renar a sintonia dos controladores de maneira
heurstica.
5
7 Conclus~oes [3] J. P. V. S. Cunha, J. L. Scieszko, R. R. Costa, L. Hsu,
and A. C. C. M. Sant'Anna, \Short range position
Neste artigo descreve{se um sistema de posicionamento measurement systems for underwater vehicle dynamic
din^amico para ROV's (DPSROV) concebido para poder positioning," in Proc. OCEANS'93, vol. 2, (Victoria),
ser aplicado a ROV's genericos, embora o sistema pp. 484{489, 1993.
prototipo tenha sido desenvolvido para o ROV Tatu. [4] T. Somers, \Precise tracking of underwater sensors," in
Os resultados de testes realizados em tanque de provas Proc. OCEANS'91, (Honolulu), pp. 274{279, 1991.
mostram que o DPSROV podera facilitar a operac~ao e [5] P. M. Tupinamba and C. J. Temke, \Um sistema de posi-
melhorar o desempenho de ROV's em intervenc~oes em cionamento din^amico de ROV's," in Anais do II Forum
aguas profundas. sobre ROV, (Rio de Janeiro), 1991.
[6] L. Hsu, R. R. Costa, and J. P. V. S. Cunha, \Simulaca~o
e desenvolvimento de sistemas de controle avancado
de ROV's," in Proc. II Forum sobre ROV, (Rio de
Janeiro), 1991.
[7] F. Ricci and P. B. Ellingsen, \The REMO project," in
0.05 Proc. ROV'92, (San Diego), 1992.
[8] J. Craig, Introduction to Robotics: Mechanics and Con-
trol. Addison{Wesley, 1986.
ye [9] \Precis~ao dos sensores," tech. rep., Programa de Enge-
(m) 0.00 nharia Eletrica, COPPE/UFRJ, Rio de Janeiro, 1992.
[10] R. B. Dominguez, \Simulaca~o e controle de um veculo
submarino de operaca~o remota," Master's thesis, Pro-
-0.05 grama de Engenharia Eletrica, COPPE/UFRJ, Rio de
Janeiro, Abril 1989.
[11] J. P. V. S. Cunha, \Projeto e estudo de simulaca~o de um
sistema de controle a estrutura variavel de um veculo
submarino de operaca~o remota," Master's thesis, Pro-
2.15 2.20 2.25 grama de Engenharia Eletrica, COPPE/UFRJ, Rio de
xe (m) Janeiro, Fevereiro 1992.
[12] D. N. Yoerger and J. J. E. Slotine, \Robust trajectory
(a) control of underwater vehicles," IEEE J. Oceanic Eng.,
vol. 10, no. 4, pp. 462{470, 1985.
[13] C. Silvestre, J. M. Lemos, M. M. Sequeira, and J. S.
6 Sentieiro, \Modelling and adaptive control of a deep-
water FSV," in 11th IFAC World Congress, (Tallinn,
Estonia), 1990.
3 [14] I. Kaminer, A. M. Pascoal, C. J. Silvestre, and P. P.
Khargonekar, \Control of an underwater vehicle using
H1 synthesis," in Proc. IEEE Conf. on Decision and
0 Control, (Brighton), 1991.
[15] J. P. V. S. Cunha, R. B. Dominguez, R. R. Costa, and
L. Hsu, \Design of a new high performance VS position
3 control of ROVs," in Proc. Int. Oshore and Polar Eng.
Conf., (Edinburgh), 1991.
6 [16] J. P. V. S. Cunha, R. R. Costa, and L. Hsu, \In-
put/output variable structure position control of a re-
motely operated underwater vehicle," in Proc. 5th Int.
Conf. on Advanced Robotics, (Pisa), 1991.
0 25 50 75 100 [17] H. Fay, Dynamic positioning systems - principles design
time (s) and applications. E ditions Technip, 1990.
(b) [18] G. T. Russel, \A design methodology for nonlinear sys-
tems," in Nonlinear system design (S. Billings, J. Gray,
and D. Owens, eds.), ch. 8, pp. 129{144, IEE, 1984.
Figura 4: Teste do DP em tanque de provas. (a) [19] K. J. Astrom and B. Wittenmark, Computer{Controlled
Posic~ao do ROV no plano horizontal. (b) A^ ngulo de Systems: Theory and Design. Prentice{Hall, 1984.
rumo. As refer^encias do controlador foram mantidas em [20] \Projeto do sistema de posicionamento din^amico para
xref = 2; 2 m; yref = 0 m; zref = 1 m; ref = 0 . o ROV Tatu," tech. rep., Programa de Engenharia
Eletrica, COPPE/UFRJ, Rio de Janeiro, 1993.
References [21] \Software do sistema de posiciona-
mento din^amico," tech. rep., Programa de Engenharia
Eletrica, COPPE/UFRJ, Rio de Janeiro, 1993.
[1] K. R. Goheen and E. R. Jeerys, \Multivariable self{ [22] A. Oppenheim and R. W. Schaer, Discrete{time Signal
tuning autopilots for autonomous and remotely operated Processing. Prentice{Hall, 1989.
underwater vehicles," IEEE J. Oceanic Eng., vol. 15,
no. 3, pp. 144{151, 1990. [23] L. Hsu, R. R. Costa, F. Sant'Anna, J. P. V. S. Cunha,
[2] J. A. Adam and K. Esch, \Technology 1991 | D. W. Junior, and A. C. Sant'Anna, \Estudo da viabili-
Aerospace/Military," IEEE Spectrum, vol. 28, no. 1, dade do posicionamento din^amico de ROV's," in Anais
pp. 72{75, 1991. do III Forum sobre ROV, (Rio de Janeiro), 1993.