Escolar Documentos
Profissional Documentos
Cultura Documentos
j
1
2
3
4
5
6
7
8
9
aj
0
1
2
3
4
5
6
7
4
j
0
0
0
0
0
0
0
0
0
rj
0
0
0
0
0
0
0
0
0
cos(
)
sin(
)
cos(
)
cos(
sin(
r
sin(
j
j
j
j
j
j
j
i
Tj =
0
0
0
1
(1)
C1 S1
S1 C1
0
T1 =
0
0
0
0
S 3 C3
C 3 S 3
2
T3 =
0
0
0
0
0 0
C 2 S 2 0 D2
S2 C2 0 0
0 0
; 1T2 =
0
1 0
0
1 0
0 1
0
0 1
0
0 D3
S 4 C 4 0 0
0
0 0 3
0
1 0
; T4 =
C 4 S 4 0 0
1 0
0 1
0
0 1
0
S 5 C 5 0 D5
S 6 C 6 0
0
0
C 5 S 5 0 0 5
1
4
T5 =
; T6 =
0
C 6 S 6 0
0 1 0
0 0 1
0
0
0
0
C 7 S 7 0 D7
C8 S 8 0
S 7 C7 0
0
6
; 7T = S 8 C 8 0
T7 =
8
0
0
0
1
0
0 1
0
0
0
1
0
0
0
S 9 C 9 0 1 D5
2
0
0
1
0
8
T9 =
C
9
S
9
0
0
0
0
0
1
0
0
1
D8
0
0
(2)
donde:
qe: vector formado por las variables articulares y las
coordenadas cartesianas del centro de masa.
Ae: matriz de inercia.
Ce: matriz de fuerzas centrfugas y de Coriolis.
Qe: vector de gravedad.
Be: matriz de seleccin de par.
JR: matriz Jacobiana que convierte las fuerzas externas en
pares articulares.
: par de los actuadores.
R: vector que representa las fuerzas externas actuando en el
punto de contacto.
Se puede asumir que la pierna de apoyo acta como un pivote
y que la pierna de avance no se desliza ni rebota, lo que hace
que el vector que representa las fuerzas externas actuando en
el punto de contacto R sea despreciable, y que ya no se
consideren las coordenadas cartesianas del centro de masa;
por lo que (2) se puede reescribir como:
Aq + Cq + Q = B
(3)
donde:
A: matriz de inercia.
C: matriz de fuerzas centrfugas de y Coriolis.
Q: vector de gravedad.
B: matriz de seleccin de par.
Las matrices y vectores de la ecuacin (3) son funciones de
los parmetros geomtricos y dinmicos del sistema. Los
parmetros dinmicos de un robot son once, seis elementos
del tensor de inercia (XXj, XYj, XZj, YYj, YZj, ZZj), tres del
primer momento de inercia (MXj, MYj, MZj), uno de la masa
(Mj) y uno de la inercia del accionador (Iaj). Debido a la
complejidad de los clculos en el modelado dinmico de un
robot cualquiera, un paso casi necesario es la simplificacin
de operaciones con el uso de los llamados parmetros
dinmicos de base del robot (Khalil and Dombre, 2002). Los
parmetros reducidos se muestran en la Tabla 2 y fueron
hallados con la ayuda del software SYMORO (Khalil and
Creusot, 1997).
Modelo de impacto. El modelo de impacto es aplicable en el
instante en que la pierna de avance toca el suelo (impacto), y
permite reiniciar el sistema para un siguiente ciclo de
caminado.
XX
XY
XZ
YY
YZ
ZZ
MX
MY
MZ
Ia
ZZ1R
MX1R
MY1
ZZ2R
MX2R
MY2
IA2
ZZ3R
MX3
MY3R
IA3
XX4R
XY4R
XZ4R
YZ4
ZZ4R
MX4R
MY4R
IA4
XX5R
XY5
XZ5
YZ5
ZZ5R
MX5
MY5R
IA5
XX6R
XY6
XZ6R
YZ6
ZZ6R
MX6R
MY6
IA6
XX7R
XY7
XZ7R
YZ7
ZZ7R
MX7R
MY7
IA7
XX8R
XY8
XZ8
YZ8
ZZ8
MX8
MY8
IA8
XX9R
XY9
XZ9
YZ9
ZZ9
MX9
MY9
IA9
anteriores al impacto q .
q
= f ( x ) + g ( x )
x + = ( x )
, x S
(4)
x = f ( x) + g ( x) , x S
x2
x
x
x
3
.
=
.
.
.
n
x f ( x) + b( x)u
(6)
(5)
(7)
xn =
(8)
(9)
q =
(10)
1
3e5
400
2
9e4
100
3
6e4
70
4
3e5
400
5
3e5
400
6
6e4
70
7
7e4
100
8
3e5
400
9
1e5
120
por lo que:
= K p ( q d q ) K v q
(11)
qd
Kp
+
Kv
+ +
Desacoplamiento y
compensacin no lineal
A(q)
+
+
Robot
q
H(q,q)
Control lineal