Professional Documents
Culture Documents
O M
OVEL DE ADES
AO MAGN
ETICA PARA
INSPECIONAR TANQUES ESF
ERICOS DE GLP
Rodrigo Val erio Espinoza
a
b
c
a
b
c
2
l
1
l
2
2
l
1
l
2
Figura 4: Parametros utilizados na modelagem ci-
nematica do robo.
robo e representada no sistema global como
G
= [ x y ]
. (1)
O modelo cinematico do robo pode ser obtido por
meio da uniao das restri coes cinematicas (de ro-
lagem e de deslocamento lateral) de suas rodas.
Para tanto e necessario descrever as rodas em re-
lacao ao sistema do robo. A Tabela (1) re une os
tres parametros que descrevem as rodas. Estes
parametros sao expressos em termos de coordena-
das polares, sendo l a distancia da roda `a origem
O(X
R
, Y
R
, Z
R
), o angulo de rota cao em Z
R
e
o angulo do plano da roda em relacao ao chassi do
robo.
Roda l
1 l
1
1
/2 +
1
2 l
2
+
2
3/2
2
3 l
2
2
/2
2
4 l
1
1
/2 +
1
Tabela 1: Parametros das rodas
A restricao de rolagem garante que toda ro-
tacao da roda implica em deslocamento do robo
(nao ha derrapagem), ou seja,
[D
a
D
b
D
c
]R()
G
r = 0, (2)
onde,
D
a
D
b
D
c
sen( +)
cos( +)
lcos()
. (3)
A segunda restricao imposta e a de desliza-
mento lateral, que estabelece que a roda nao pode
se deslocar no plano ortogonal ao seu, isto e,
[C
a
C
b
C
c
]R()
G
= 0, (4)
onde,
C
a
C
b
C
c
cos( +)
sen( +)
lsen()
. (5)
A uniao das restricoes de rolagem e deslizamento
lateral (Equa coes 2 e 4) para todas as rodas resul-
tam no arranjo cinematico,
D
C
R()
G
=
J
R
Z
, (6)
onde D e C sao uma matrizes 4 3 contendo os
coecientes das equacoes de restricao de rolagem
e deslocamento lateral, J
R
e uma matriz 4 4
cuja diagonal relaciona os raios das rodas, e
a matriz 4 1 de velocidade angular das rodas
[
1
1
2
2
]
G
, (7)
onde,
J
1
=
J
1
R
D
C
R(). (8)
Da Equa cao (7) chega-se diretamente `a equa cao
da cinematica diferencial direta do robo,
G
= J . (9)
A validacao do modelo cinematico e realizada com
a aplicacao de uma trajetoria curva, impondo `as
juntas um perl de velocidade trapezoidal. O atu-
ador responsavel pelo movimento das rodas 1 e 2
possui velocidade superior ao que aciona as rodas
3 e 4. A Figura 5 exibe a trajetoria, sendo a ori-
gem da mesma o ponto (0,0).
2.4 Modelo Din amico
O deslocamento no espa co tridimensional adiciona
complexidade ao sistema, pois neste caso o robo
deve ser capaz de se mover em planos perpendicu-
lares ao plano da terra. Em sistemas roboticos mo-
veis, o efeito da for ca gravitacional normalmente
0 100 200 300 400 500
0
50
100
150
200
250
300
350
Xglobal Distncia[cm]
Y
g
l
o
b
a
l
D
i
s
t
n
c
i
a
[
c
m
]
Figura 5: Trajetoria simulada.
e negligenciado, pois os sistemas navegam apenas
no plano perpendicular `a gravidade. Entretanto, a
inspecao de tanques requer movimento em todas
orienta coes, logo a forca gravitacional nao pode
ser negligenciada porque sua inuencia prejudica
a navegacao.
Figura 6: For cas atuantes no deslocamento na su-
perfcie interna do tanque.
Em robos moveis os atuadores das rodas sao
responsaveis por gerar o torque do sistema de loco-
mo cao e devem ser capazes de mover o robo contra
a forca de atrito (F
at
) e a componente supercial
da forca gravitacional (G
X
), como apresentado
na Figura (6).
A compensacao ativa da forca gravitacional
(CAFG) usa as informa coes de aceleracao e ori-
entacao do corpo rgido, adquiridos do sistema de
navegacao inercial (composto por acelerometros e
giroscopios), para determinar a inuencia gravita-
cional real na direcao de giro dos atuadores. Os
torques dos atuadores () compensam a inuen-
cia gravitacional adicionando no controlador de
trajetoria uma por cao de torque proporcional `a
inuencia gravitacional supercial, como,
(t+1)
=
(t)
+K
p
(q) e
+K
d
(q)
, (10)
Onde ,
e o torque com compensa cao gravi-
tacional, K
p
e o ganho proporcinal, e e o erro de
velocidade no espa co dos atuadores, K
d
e o ganho
derivativo e
e e o erro de aceleracao no espaco dos
atuadores.
O torque com a CAFG e determinado de
acordo com a correla cao entre as medicoes de ace-
leracao obtidas pelo acelerometro de 3 graus de
liberdade (por meio da lei de movimento de new-
ton) e pela orienta cao espacial do corpo rgido ob-
tida pelo giroscopio,
M()
V
m
(,
) +
F
fric
( ) +
G(), (11)
onde,
V
m
(,
) e a matriz com as componentes
reais centrpeta e Coriolis,
F
fric
( ) e a compo-
nente real de friccao supercial,
o
[
p
u
l
s
o
s
d
o
e
n
c
o
d
e
r
]
Desejado
Obtido
Figura 8: Resposta do controlador de posicao.
O controlador de velocidade apresenta erros
iniciais devido `a perturbacao da for ca magnetica
e da forca de atrito. Entretanto, no momento que
o movimento inicia (ou seja, exista velocidade) a
resposta come ca a convergir para o desejado mi-
nimizando a oscilacao, como visto na Figura (9).
0 500 1000 1500 2000
0
100
200
300
400
500
600
700
Tempo [ms]
V
e
l
o
c
i
d
a
d
e
[
r
p
m
]
Desejado
Obtido
Figura 9: Resposta do controlador de velocidade.
4 Resultados Experimentais
O robo foi projetado para trabalhar em estruturas
esfericas, contudo os ensaios iniciais foram realiza-
dos em uma estrutura cilndrica, Figura (10), pois
a mesma garante que aspectos de funcionalidade
e performance do robo sejam analisados.
Figura 10: Estrutura de testes cilndrica.
No primeiro teste, validou-se o conceito do
robo e o projeto das rodas, pois RE consegue se
movimentar por toda estrutura e passar por pe-
quenos obstaculos (deformacoes na superfcie da
estrutura) que perturbam a forca de adesao mag-
netica das rodas.
O seguinte teste vericou a capacidade do RE
de carregar carga extra, um teste de versatilidade,
pois quanto maior a carga extra admissvel, maior
a capacidade do robo de carregar equipamentos
extras. A Figura (11) exibe o robo durante o teste.
Vericou-se que ele pode carregar uma carga de
12kg (mesmo que seu peso) respeitando as condi-
coes cinematicas de nao derrapagem.
A Figura (12) exibe o perl de velocidade das
rodas para a trajetoria de subida e descida do robo
na superfcie interna do cilindro.
A trajetoria delimitada exige que a velocidade
angular do robo assemelhe-se ao perl de veloci-
dade das rodas. A Figura (13) exibe os dados ad-
quiridos pelo giroscopio e, como esperado, e veri-
cada a similaridade. As pequenas variacoes ocor-
rem devido imperfei coes da superfcie de teste.
5 Conclusoes
Este artigo apresentou o projeto de um RE de-
senvolvido para inspecionar tanques de GLP. O
objetivo deste trabalho foi desenvolver os modelos
cinematicos e dinamicos de modo a otimizar a ope-
racao do robo em seu ambiente de trabalho. Ajus-
tes do controlador de tra cao foram realizados com
Figura 11: Ensaio de carga realizado na superfcie
interna do cilindro.
0 5 10 15 20 25 30
6000
4000
2000
0
2000
4000
6000
Tempo [s]
V
e
l
o
c
i
d
a
d
e
A
n
g
u
l
a
r
[
r
p
m
]
Figura 12: Velocidade angular dos motores - en-
coders.
0 5 10 15 20 25 30
2
1.5
1
0.5
0
0.5
1
1.5
2
x 10
4
Tempo [s]
V
e
l
o
c
i
d
a
d
e
A
n
g
u
l
a
r
[
m
i
l
i
g
r
a
u
s
/
s
]
Adquirido
Filtrado
Figura 13: Velocidade angular no espa co operaci-
onal do robo - giroscopio.
sucesso, propiciando que o prototipo atendesse os
requesitos de trabalho no ambiente de testes. Os
resultados dos testes mostraram que a topologia
mecanica e o projeto das rodas atingiram seu ob-
jetivo em performance com folga. A resposta de
velocidade do sistema foi precisa, sem acao danosa
da gravidade em seu perl. Futuros trabalhos irao
focar as areas de arquitetura de controle do robo,
comunica cao, navegacao e inspecao por ultrassom.
Agradecimentos
Este trabalho foi parcialmente nanciado pelo
Conselho Nacional de Desenvolvimento Cientco
e Tecnologico (CNPq).
Referencias
Caprari, G., Breitenmoser, A., Fischer, W., H ur-
zeler, C., Tache, F., Siegwart, R., Nguyen,
O., Moser, R., Schoeneich, P. and Mondada,
F. (2012). Highly compact robots for inspec-
tion of power plants, Journal of Field Robo-
tics 29: 4768.
Chu, B., Jung, K., Han, C. and Hong, D.
(2010). A survey of climbing robots: Loco-
motion and adhesion, International Journal
of Precision Engineering and Manufacturing
11: 633647.
de Oliveira, A. S., de Arruda, L. V. R., Ju-
nior, F. N., Espinoza, R. V. and ao Pe-
dro Battistella Nadas, J. (2012). Adhesion
force control and active gravitational com-
pensation for autonomous inspection in lpg
storage spheres., Robotics Symposium and
Latin American Robotics Symposium (SBR-
LARS), pp. 232238.
Fischer, W., Caprari, G., Siegwart, R. and Moser,
R. (2011). Locomotion system for a mobile
robot on magnetic wheels with both axial and
circumferential mobility and with only an 8-
mm height for generator inspection with the
rotor still installed, IEEE Transactions on
Industrial Electronics 58: 52965303.
Guan, Y., Jiang, L., Zhu, H., Zhou, X., Cai, C.,
Wu, W., Li, Z., Zhang, H. and Zhang, X.
(2011). Climbot: A modular bio-inspired bi-
ped climbing robot, Intelligent Robots and
Systems (IROS), 2011 IEEE/RSJ Internati-
onal Conference on, pp. 14731478.
Osswald, M. and Iida, F. (2011). A climbing robot
based on hot melt adhesion, Intelligent Ro-
bots and Systems (IROS), 2011 IEEE/RSJ
International Conference on, pp. 51075112.
Rovani, A. (2013). Desenvolvimento do proto-
tipo de um robo para inspecao de cordoes de
solda em superfcies metalicas verticais, Tra-
balho de Conclusao de Curso - Engenharia
Industrial Mecanica - Universidade Tecnolo-
gica Federal do Parana, Curitiba. p. 117.