Está en la página 1de 64

Herramientas matemáticas para la

localización espacial

UNIDAD
III

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 1
Ingeniería Mecatrónica
Unidad N°3. Herramientas matemáticas para la localización espacial

3.1 Representación de la posición


3.1.1 Sistema cartesiano de referencia
3.1.2 Coordenadas cartesianas
3.1.3 Coordenadas polares y cilíndricas
3.1.4 Coordenadas esféricas
3.2 Representación de la orientación
3.2.1 Matrices de rotación
3.2.2 Ángulos de Euler
3.2.3 Par de rotación
3.2.4 Cuaternios.
3.3 Matrices de transformación homogéneas
3.3.1 Coordenadas y matrices homogéneas
3.3.2 Aplicaciones de las matrices homogéneas
3.3.3 Significado geométrico de las matrices homogéneas
3.3.4 Composición de matrices homogéneas
3.3.5 Gráficos de transformación
3.4 Aplicación de los cuaternios
3.4.1 Álgebra de cuaternios
3.4.2 Utilización de los cuaternios
3.5 Relación y comparación entre los distintos métodos de localización espacial
3.5.1 Comparación de métodos de localización espacial.
3.5.2 Relación entre los distintos métodos de localización espacial.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 2
Ingeniería Mecatrónica
HERRAMIENTAS MATEMATICAS PARA LA LOCALIZACIÓN ESPACIAL

La manipulación de piezas llevada a cabo por un robot implica el


movimiento espacial de su extremo. Asimismo, para que el robot pueda
recoger una pieza, es necesario conocer la posición y orientación de esta
con respeto a la base del robot.

Se aprecia entonces la necesidad de contar con una serie de herramientas


matemáticas que permitan especificar la posición y orientación en el
espacio de piezas, herramientas y, en general, de cualquier objeto.

Estas herramientas han de ser lo suficientemente potentes como para


permitir obtener de forma sencilla relaciones espaciales entre distintos
objetos y en especial entre éstos y el manipulador

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 3
Ingeniería Mecatrónica
REPRESENTACIÓN DE LA POSICIÓN

Para localizar un cuerpo rígido en el espacio es necesario contar con una


herramienta que permita la localización espacial de sus puntos. En un plano el
posicionamiento tiene dos grados de libertad, y por tanto la posición de un
punto vendrá definida por dos componentes independientes. En el caso de un
espacio tridimensional será necesario emplear tres componentes. La forma
más intuitiva y utilizada de especificar la posición de un punto son
coordenadas cartesianas.

Sistema cartesiano de referencia

Normalmente los sistemas de referencia se definen mediante ejes


perpendiculares entre sí con un origen definido. Estos se denominan sistemas
cartesianos, y en el caso de trabajar en el plano (2 dimensiones), el sistema
de referencia OXY correspondiente queda definido por dos vectores
coordenados OX y OY perpendiculares entre sí con un punto de intersección
común O.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 4
Ingeniería Mecatrónica
Si se trabaja en el espacio (tres dimensiones), el sistema cartesiano OXYZ está
compuesto por una terna ortonormal de vectores coordenados OX, OY y OZ, tal
y como se ve en la siguiente figura.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 5
Ingeniería Mecatrónica
Coordenadas cartesianas
Si se trabaja en un plano, con su sistema coordenado OXY de referencia
asociado, un punto a vendrá expresado por las componentes (x, y)
correspondientes a los ejes coordenados del sistema OXY. Este punto tiene
asociado un vector p(x, y), que va desde el origen O del sistema OXY hasta el
punto a .Por tanto, la posición del extremo del vector p está caracterizado por las
dos componentes (x, y), denominadas coordenadas cartesianas del vector y que
son las proyecciones del vector p sobre los ejes OX y OY.
En el caso que se trabaje en tres dimensiones, un vector viene definido con
respecto al sistema de referencia OXYZ mediante las coordenadas
correspondientes a cada uno de los ejes coordenados. En este caso, el vector p
estará definido por las componentes cartesianas (xyz)

Vectores en coordenadas
cartesianas de 2 (a) y 3
dimensiones (b)

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 6
Ingeniería Mecatrónica
Coordenadas polares y cilíndricas

Para un plano, es posible también caracterizar la localización de un punto o


vector p respecto a un sistema de ejes cartesianos de referencia OXY
utilizando las denominadas coordenadas polares p(r, θ). En esta
representación, r representa la distancia desde el origen O del sistema hasta
el extremo del vector p, mientras que θ es el ángulo que forma el vector p con
el eje OX .
En el caso de trabajar en tres dimensiones, un vector p podrá expresarse con
respecto a un sistema de referencia OXYZ, mediante las coordenadas
cilíndricas p(r, θ, z).

Representación de
coordenadas polares (a) y
cilíndricas (b)

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 7
Ingeniería Mecatrónica
Las componentes r y θ tienen el mismo significado que en el caso de
coordenadas polares, aplicado el razonamiento sobre el plano OXY, mientras
que la componente z expresa la proyección sobre el eje OZ del vector p.

Coordenadas esféricas
También es posible utilizar coordenadas esféricas para realizar la localización de
un vector en un espacio de tres dimensiones. Utilizando el sistema de referencia
OXYZ, el vector p tendrá como coordenadas esféricas (r, θ, φ), donde la
componente r es la distancia desde el origen O hasta el extremo del vector p; la
componente θ es el ángulo formado por la proyección del vector p sobre el plano
OXY con el eje OX; y la componente φ es el ángulo formado por el vector p con
el eje OZ.

Representación de un vector en
coordenadas esféricas

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 8
Ingeniería Mecatrónica
REPRESENTACIÓN DE LA ORIENTACIÓN

Un punto queda totalmente definido en el espacio a través de los datos de su


posición. Sin embargo, para el caso de un sólido, es necesario adema definir
cuál es su orientación con respecto a un sistema de referencia.
En el caso de un robot, no es suficiente con especificar cuál debe ser la
posición de su extremo, sino que en general, es también necesario indicar su
orientación.
Por ejemplo, en el caso de un robot que tenga que realizar sobre una pieza
curva una operación de pulido, no bastaría con especificar los puntos de la
superficie para situar adecuadamente la herramienta, sino que será necesario
también conocer la orientación con que la herramienta ha de realizar la
operación.
Una orientación en el espacio tridimensional viene definida por tres grados de
libertad o tres componentes linealmente independientes.
Para poder describir de forma sencilla la orientación de un objeto respecto a un
sistema de referencia, es habitual asignar solidariamente al objeto un nuevo
sistema, y después estudiar la relación espacial existente entré los dos
sistemas.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 9
Ingeniería Mecatrónica
Matrices de rotación

Las matrices de rotación son el método más extendido para la descripción de


orientaciones, debido principalmente a la comodidad que proporciona el uso
del algebra matricial. Supóngase que se tiene en el plano dos sistemas de
referencia OXY y OUV con un mismo origen O, siendo el sistema OXY el de
referencia fija y el sistema OUV el móvil solidario al objeto. Los vectores
unitarios de los ejes coordenados del sistema OXY son ix, jy, mientras que los
del sistema OUV son iu, jv.

Orientación de un sistema OUV (a)


respecto a otro OXY en un plano (b)

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 10
Ingeniería Mecatrónica
Realizando una sencilla serie de transformaciones se puede llegar a la
siguiente equivalencia:

Es la llamada matriz de rotación, que define la orientación del sistema OUV con
respeto al sistema OXY, y que sirve para transformar las coordenadas de un
vector en un sistema a las del otro. También recibe el nombre de matriz de
cosenos directores. Es fácil de comprobar que se trata de una matriz
ortonormal, tal que R-1= RT En el caso de dos dimensiones, la orientación
viene definida por un único parámetro independiente. Si se considera la
posición relativa del sistema OUV girado un ángulo α OXY, (tras realizar los
correspondientes productos escalares, la matriz R será de la forma:

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 11
Ingeniería Mecatrónica
Para el caso en que α = 0, en el que los ejes coordenados de ambos sistemas
coinciden, la matriz R corresponderá a la matriz unitaria. En un espacio
tridimensional, el razonamiento a seguir es similar. Supóngase los sistemas
OXYZ y OUVW, coincidentes en el origen, siendo el OXYZ el sistema de
referencia fijo, y el OUVW el solidario al objeto cuya orientación se desea
definir. (Figura 3.5-a). Los vectores unitarios del sistema OXYZ serán ix, jy,
kz, mientras que los del OUVW serán iu, jv, kw. Un vector p del espacio podrá
ser referido a cualquiera de los sistemas de la siguiente manera:

Y al igual que en dos dimensiones, se


puede obtener la siguiente equivalencia:

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 12
Ingeniería Mecatrónica
Donde:

Es la matriz de rotación que define la orientación del sistema OUVW con


respecto al sistema OXYZ. Al igual que en dos dimensiones, también recibe el
nombre de matriz de cosenos directores y se trata de una matriz ortonormal, tal
que la inversa de la matriz R es igual a su traspuesta R-1= RT. La principal
utilidad de esta matriz de rotación corresponde a la representación de la
orientación de sistemas girados únicamente sobre uno de los ejes principales
del sistema de referencia.
La orientación del sistema OUVW, con el eje OU coincide con el eje OX,
vendrá representada mediante la matriz:

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 13
Ingeniería Mecatrónica
La orientación del sistema OUVW, con el eje OV coincidente con el eje OY,
vendrá representada mediante la matriz:

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 14
Ingeniería Mecatrónica
La orientación del sistema OUVW, con el eje OW coincidente con el eje OZ,
vendrá representada mediante la matriz:

Estas tres matrices, se denominan matrices básicas de rotación de un


sistema espacial de tres dimensiones

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 15
Ingeniería Mecatrónica
Composición de rotaciones

Las matrices de rotación pueden componerse para expresar la


aplicación continua de varias rotaciones.
Así, si al sistema OUVW se le aplica una rotación de ángulo α sobre
OX, seguida de una rotación de ángulo φ sobre OY y de una
rotación de ángulo θ sobre OZ, la rotación global puede expresarse
como:

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 16
Ingeniería Mecatrónica
Es importante considerar el orden en que se realizan las rotaciones,
pues el producto de matrices no es conmutativo.
Así, si la rotación se hiciera primero un ángulo θ sobre OZ, seguida
de una rotación de ángulo φ sobre OY, para finalizar con otra
rotación de ángulo α sobre OX, la rotación global vendría expresada
por:

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 17
Ingeniería Mecatrónica
Ángulos de Euler

Para la representación de orientación en un espacio tridimensional mediante una


matriz de rotación es necesario definir nueve elementos.
Aunque la utilización de las matrices de rotación presente múltiples ventajas,
existen otros métodos de definición de orientación que hacen únicamente uso de
tres componentes para su descripción. Este es el caso de los llamados ángulos
de Euler.
Todo el sistema OUVW solidario al cuerpo cuya orientación se quiere describir,
puede definirse con respecto al sistema OXYZ mediante tres ángulos: φ, θ, ψ,
denominados ángulos de Euler.
Girando sucesivamente el sistema OXYZ sobre unos ejes determinados de un
triedro ortonormal los valores de φ, θ, ψ, se obtendrá el sistema OUVW.
Es necesario, por tanto, conocer además de los valores de los ángulos, cuáles
son los ejes sobre los que se realizan los giros. Existen diversas posibilidades,
siendo las tres más usuales las que se muestran a continuación:

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 18
Ingeniería Mecatrónica
Ángulos de Euler ZXZ

Es una de las representaciones más habituales entre las que se


realizan los giros sobre ejes previamente girados. Se le suele asociar
con los movimientos básicos de un giroscopio. Si se parte de los
sistemas OXYZ y OUVW, inicialmente coincidentes, se puede colocar
al sistema OUVW en cualquier orientación siguiendo los siguientes
pasos.

1. Girar el sistema OUVW un ángulo φ con respecto al eje


OZ, convirtiéndose así en el OU’V’W’.
2. Girar el sistema OU’V’W’ un ángulo θ con respecto al eje
OU’, convirtiéndose así en el OU’’V’’W’’.
3. Girar el sistema OU’’V’’W’’ un ángulo ψ con respecto al eje
OW’’, convirtiéndose así en el OU’’’V’’’W’’’.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 19
Ingeniería Mecatrónica
Es importante que estas operaciones se realicen en la secuencia
especificada, pues las operaciones de giros consecutivos sobre
ejes no son conmutativas.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 20
Ingeniería Mecatrónica
1. Girar el sistema OUVW un ángulo φ ZW
W´´ W´
con respecto al eje OZ, convirtiéndose
así en el OU’V’W’. Ψ ф V´´´
2. Girar el sistema OU’V’W’ un ángulo θ V´´
W´´´ Ψ
con respecto al eje OU’, convirtiéndose Θ
así en el OU’’V’’W’’. Θ
3. Girar el sistema OU’’V’’W’’ un ángulo V´
ψ con respecto al eje OW’’, O ф
convirtiéndose así en el OU’’’V’’’W’’’. YV
ф
Ψ
UX
Θ
U´ U´´
U´´´

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 21
Ingeniería Mecatrónica
Ángulos de Euler ZYZ

Es otra de las representaciones más habituales entre las que realizan


los giros sobre ejes previamente girados.
Sólo se diferencia del anterior en la elección del eje sobre el que se
realiza el segundo giro. Si se parte de los sistemas OXYZ y OUVW,
inicialmente coincidentes, se puede colocar al sistema OUVW en
cualquier orientación siguiendo los siguientes pasos.
1. Girar el sistema OUVW un ángulo
φ con respecto al eje
OZ, convirtiéndose así en el OU’V’W’.
2. Girar el sistema OU’V’W’ un ángulo
θ con respecto al eje
OV’, convirtiéndose así en el
OU’’V’’W’’.
3. Girar el sistema OU’’V’’W’’ un
ángulo ψ con respecto al eje
OW’’, convirtiéndose así en el
OU’’’V’’’W’’’.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 22
Ingeniería Mecatrónica
Roll, pitch y yaw

Se trata de la representación utilizada en aeronáutica. Es también la


más habitual de entre las que se aplican a los giros sobre los ejes
del sistema fijo. Si se parte de los sistemas OXYZ y OUVW, al igual
que en el caso anterior, se puede colocar al sistema OUVW en
cualquier orientación siguiendo los siguientes pasos.

1. Girar el sistema OUVW un ángulo ψ


con respecto al eje
OX. Es el denominado Yaw.
2. Girar el sistema OUVW un ángulo θ
con respecto al eje OY.
Es el denominado Pitch.
3. Girar el sistema OUVW un ángulo φ
con respecto al eje
OZ. Es el denominado Roll.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 23
Ingeniería Mecatrónica
Matrices de transformación homogénea

Coordenadas y matrices homogéneas

La representación mediante coordenadas homogéneas de la


localización de sólidos en un espacio n-dimensional se realiza a
través de coordenadas de un espacio (n+1)-dimensional. Es decir,
un espacio n-dimensional se encuentra representado en
coordenadas homogéneas por (n+1)-dimensiones, de tal forma
que un vector p(x,y,z) vendrá representado por p(wx,wy,wz,w),
donde w tiene un valor arbitrario y representa un factor de escala.
De forma general, un vector p = ai + bj + ck, donde i, j y k son
los vectores unitarios de los ejes OX, OY y OZ del sistema de
referencia OXYZ, se representa en coordenadas homogéneas
mediante el vector columna:

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 24
Ingeniería Mecatrónica
Por ejemplo, el vector 2i + 3j + 4k se puede representar en
coordenadas homogéneas como [2,3,4,1]T o como [4,6,8,2]T o también
como [-6,-9,-12,-3]T.
Los vectores nulo se representan [0,0,0,n]T, donde n es no nulo.
Los vectores de la forma [a,b,c,0]T sirven para representar direcciones,
pues representan vectores de longitud infinita.

A partir de la definición de las coordenadas homogéneas surge inmediatamente


el concepto de matriz de transformación homogénea. Se define como matriz de
transformación homogénea T a una matriz de dimensión 4 x 4 que representa
la transformación de un vector de coordenadas homogéneas de un sistema de
coordenadas a otro.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 25
Ingeniería Mecatrónica
Se puede considerar que una matriz homogénea se halla compuesta
por cuatro submatrices de distinto tamaño: una submatriz R3x3 que
corresponde a una matriz de rotación; una submatriz p3x1 que
corresponde al vector de traslación; una submatriz f1x3 que
corresponde a una transformación de perspectiva, y una submatriz
w1x1 que representa un escalado global.
En robótica generalmente sólo interesara conocer el valor de R3x3 y de
p3x1, considerándose las componentes de f1x3 nulas y las de w1x1 la
unidad.
Al tratarse de una matriz 4x4, los vectores sobre los que se aplique
deberán contar con 4 dimensiones, que serán las coordenadas
homogéneas del vector tridimensional que se trate.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 26
Ingeniería Mecatrónica
Aplicación de las matrices homogéneas

Se considera la transformación de perspectiva nula y el escalado


global unitario, la matriz homogénea T resultará ser de la siguiente
forma.

que representa la orientación y posición de un sistema O’UVW rotado y


trasladado con respecto al sistema de referencia OXYZ.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 27
Ingeniería Mecatrónica
Esta matriz sirve para conocer las
coordenadas (rx, ry, rz) del vector r en
el sistema OXYZ a partir de sus
coordenadas (ru, rv, rw) en el sistema
O’XYZ:

También se puede utilizar para


expresar la rotación y traslación de
un vector respecto de un sistema de
referencia fijo OXYZ, de tal manera
que un vector rxyz rotado según R3x3 y
trasladado según p3x1 se convierte en
el vector r’xyz dado por:

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 28
Ingeniería Mecatrónica
Una matriz de transformación homogénea se puede aplicar para:

1.Representar la posición y orientación de un sistema girado y


trasladado O’UVW con respecto a un sistema fijo de referencia OXYZ,
que es lo mismo que representar una rotación y traslación realizada
sobre un sistema de referencia.

2.Transformar un vector expresado en coordenadas con respecto a


un sistema O’UVW, a su expresión en coordenadas del sistema de
referencia OXYZ.

3. Rotar y trasladar un vector con respecto a un sistema de referencia


fijo.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 29
Ingeniería Mecatrónica
Traslación

Supóngase que el sistema O’UVW únicamente se encuentra


trasladado un vector p = pxi + pyj + pzk con respecto al sistema
OXYZ. La matriz T entonces corresponderá a una matriz homogenea
de traslación:

que es la denominada matriz de traslación.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 30
Ingeniería Mecatrónica
Un vector cualquiera r, representado en el sistema O’UVW por ruvw,
tendrá como componentes del vector con respecto al sistema OXYZ:

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 31
Ingeniería Mecatrónica
Y a su vez, un vector rx,y,z desplazado según T tendrá como
componentes r’x,y,z:

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 32
Ingeniería Mecatrónica
Ejemplo

Según la figura el sistema O’UVW está trasladado un vector p(6,-3,8)


con respecto del sistema OXYZ. Calcular las coordenadas (rx, ry, rz)
del vector r cuyas coordenadas con respecto al sistema OUVW son
ruvw(-2,7,3).

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 33
Ingeniería Mecatrónica
Carlos Alberto Vera
Ing. Electrónico
Robótica Industrial 1 34
Ingeniería Mecatrónica
Carlos Alberto Vera
Ing. Electrónico
Robótica Industrial 1 35
Ingeniería Mecatrónica
Ejemplo

Calcular el vector r’xyz resultante de trasladar al vector


rxyz(4,4,11) segun la transformación T(p) con p(6,-3,8).

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 36
Ingeniería Mecatrónica
Carlos Alberto Vera
Ing. Electrónico
Robótica Industrial 1 37
Ingeniería Mecatrónica
Carlos Alberto Vera
Ing. Electrónico
Robótica Industrial 1 38
Ingeniería Mecatrónica
Rotación

Supóngase que ahora el sistema O’UVW sólo se encuentra rotado


con respecto al sistema OXYZ. La submatriz de rotación R3x3 será
la que defina la rotación. Se definen tres matrices para que se
realice la rotación a lo largo de los ejes OX, OY y OZ del sistema
OXYZ.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 39
Ingeniería Mecatrónica
Un vector cualquiera r, representado en
el sistema girado O’UVW por ruvw, tendrá
como componentes (rx, ry, rz) en el
sistema OXYZ las siguientes:

Y a su vez un vector rx,y,z


rotado según T vendrá
expresado por r’x,y,z
según:

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 40
Ingeniería Mecatrónica
Traslación junto con rotación

La principal ventaja de las matrices homogéneas reside en su


capacidad de representación conjunta de posición y orientación.
En esta representación se realiza utilizando al mismo tiempo la
matriz de rotación R3x3 y el vector de traslación p3x1 en una misma
matriz de transformación homogénea.

La traslación y la rotación son transformaciones que se realizan en


relación a un sistema de referencia.
Por lo tanto, si se requiere expresar la posición y orientación de un
sistema O’UVW, originalmente coincidente con el de referencia y
que ha sido rotado y trasladado según éste, habrá que tener en
cuenta si primero se ha realizado la rotación o viceversa, pues se
trata de transformaciones espaciales no conmutativas.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 41
Ingeniería Mecatrónica
Se parte de un sistema OUVW coincidente con OXYZ al que se va a
aplicar una traslación según un vector px,y,z y una rotación de 180°
alrededor del eje OZ. Si primero se rota y después se traslada se
obtiene un sistema final O’V’U’W’.
En cambio, si primero se traslada y después se rota se obtiene otro
sistema final O’’U’’V’’W’’, que representa una localización
totalmente distinta a la del sistema final anterior.
Se tendrá entonces matrices homogéneas distintas según se realice
una traslación seguida de una rotación o una rotación seguida de
una traslación.
Eso se muestra en la siguiente figura.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 42
Ingeniería Mecatrónica
Rotación seguida de traslación

Para el caso de realizar primero una rotación sobre uno de los ejes
coordenados del sistema OXYZ seguida de una traslación, las
matrices homogéneas serán las que a continuación se expresan.
Rotación de un ángulo α sobre el eje OX seguido de una traslación
de vector px,y,z:

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 43
Ingeniería Mecatrónica
Rotación de un ángulo φ sobre el eje OY seguido de una traslación
de vector px,y,z:

Rotación de un ángulo θ sobre el eje OZ seguido de una traslación


de vector px,y,z:

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 44
Ingeniería Mecatrónica
Traslación seguida de rotación

Para el caso de realizar primero una traslación seguida de una


rotación sobre los ejes coordenados del sistema OXYZ, las
matrices homogéneas resultantes son las siguientes:
Traslación del vector px,y,z seguida de rotación de ángulo α sobre el
eje OX.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 45
Ingeniería Mecatrónica
Traslación de vector px,y,z seguida de rotación de un ángulo φ sobre
el eje OY.

Traslación de vector px,y,z seguida de rotación de un ángulo θ sobre


el eje OZ.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 46
Ingeniería Mecatrónica
Ejemplo

Un sistema OUVW ha sido girado 90° alrededor del eje OX y


posteriormente trasladado un vector p(8, -4, 12) con respecto al
sistema OXYZ. Calcular las coordenadas (rx, ry , rz) del vector r con
coordenadas ruvw (-3, 4, -11).

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 47
Ingeniería Mecatrónica
Carlos Alberto Vera
Ing. Electrónico
Robótica Industrial 1 48
Ingeniería Mecatrónica
Carlos Alberto Vera
Ing. Electrónico
Robótica Industrial 1 49
Ingeniería Mecatrónica
Ejemplo

Un sistema OUVW ha sido trasladado un vector p(8, -4, 12) con


respecto al sistema OXYZ y girado 90° alrededor del eje OX.
Calcular las coordenadas (rx, ry, rz) del vector r de coordenadas
ruvw(-3, 4, -11).

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 50
Ingeniería Mecatrónica
Carlos Alberto Vera
Ing. Electrónico
Robótica Industrial 1 51
Ingeniería Mecatrónica
Carlos Alberto Vera
Ing. Electrónico
Robótica Industrial 1 52
Ingeniería Mecatrónica
Composición de matrices homogéneas

Una matriz de transformación homogénea sirve, entre otras


cosas, para representar el giro y la traslación realizados
sobre un sistema de referencia.
Esta utilidad de las matrices homogéneas cobra aun mas
importancia cuando se componen las matrices homogéneas
para describir diversos giros y traslaciones consecutivos
sobre un sistema de referencia determinado.
De esta forma, una transformación compleja podrá
descomponerse en la aplicación consecutiva de
transformaciones simple (giros básicos y traslaciones).

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 53
Ingeniería Mecatrónica
De forma general, a la hora de componer diversas transformaciones
mediante matrices homogéneas, se han de tener en cuenta los
siguiente criterios:

1.Si el sistema fijo OXYZ y el sistema transformado O’UVW son


coincidentes, la matriz homogénea de transformación será la matriz
4x4 identidad, I4.

2.Si el sistema O’UVW se obtiene mediante rotaciones y traslaciones


definidas con respecto al sistema fijo OXYZ, la matriz homogénea
que representa cada transformación se deberá premultiplicar sobre
las matrices de las transformaciones previas.

3. Si el sistema O’UVW se obtiene mediante rotaciones y traslaciones


definidas con respecto al sistema móvil, la matriz homogénea que representa
cada transformación se deberá postmultiplicar sobre las matrices de las
transformaciones previas.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 54
Ingeniería Mecatrónica
Ejemplo

Se quiere obtener la matriz de transformación que representa al


sistema O’UVW obtenido de a partir del sistema OXYZ mediante un
giro de angulo -90° alrededor del eje OX, de una traslación de
vector pxyz(5, 5, 10) y un giro de 90° sobre el eje OZ.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 55
Ingeniería Mecatrónica
Carlos Alberto Vera
Ing. Electrónico
Robótica Industrial 1 56
Ingeniería Mecatrónica
Cuaternios

Los cuaternios, definidos por Hamilton, pueden ser utilizados como


herramienta matemática de gran versatilidad computacional para
trabajar con giros y orientaciones. Son empleados por algunos robots
comerciales como los ABB.
Un cuaternio Q está constituido por cuatro componentes (q0, q1, q2,
q3) que representan las coordenadas del cuaternio en una base
{e,i,j,k}. Es frecuente denominar parte escalar del cuaternio a la
componente en e: q0, y parte vectorial al resto de componentes. De
modo que un cuaternio se puede representar como:

donde s representa la parte escalar, y v la parte vectorial.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 57
Ingeniería Mecatrónica
Para la utilización de los cuaternios como metodología de
representación de orientaciones se asocia el giro de un ángulo θ
sobre el vector k al cuaternio definido por:

luego la aplicación de la rotación expresada por el cuaternio Q a un


vector r, vendrá definida por el producto:

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 58
Ingeniería Mecatrónica
La composición de rotaciones con cuaternios resulta tan sencilla
como multiplicar cuaternios entre sí. De tal forma que el resultado
de rotar según el cuaternio Q1, para posteriormente rotar según
Q2, es el mismo que el de rotar según Q3, obtenido por la
expresión:

Q3 = Q2 ◦ Q1

Hay que recordar que el producto de cuaternios no es conmutativo.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 59
Ingeniería Mecatrónica
En el caso de componer rotaciones con traslaciones se procede como
sigue: el resultado de aplicar una traslación de vector p seguida de
una rotación Q al sistema OXYZ, es un nuevo sistema OUVW, tal que
las coordenadas de un vector r en el sistema OXYZ, conocidas en
OUVW, serán:

(0,rxyz) = Q ◦ (0,ruvw) ◦ Q* + (0,r)

El resultado de primero rotar y luego trasladar el sistema vendrá


dado por:

(0,rxyz) = Q ◦ (0,ruvw + p) ◦ Q*

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 60
Ingeniería Mecatrónica
Si se mantiene el sistema OXYZ fijo y se traslada el vector r según p
y luego se le rota según Q se obtendrá el vector r’ de coordenadas:

(0,r’) = Q ◦ (0,r + p) ◦ Q*

Y si se aplica primero el giro y después la traslación p al vector r,


éste se convertirá en el r’ a través de la expresión:

(0,r’) = Q ◦ (0,r) ◦ Q* + (0,p)

Se observa que la aplicación de cuaternio para la composición de rotaciones


es un método computacional muy práctico, pues basta multiplicar cuaternios
entre sí, lo que corresponde a una expresión de productos y sumas muy
simple.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 61
Ingeniería Mecatrónica
Comparación de métodos de localización espacial

La comparación se realiza fundamentalmente en razón a su


capacidad para la realización de cuatro cuestiones básicas de
toda transformación.

1. Capacidad de representación conjunta de posición y orientación.

2.Representar la posición y orientación de un sistema rotado y


trasladado O’UVW con respecto a un sistema fijo de referencia
OXYZ. Que es lo mismo que representar una rotación y
traslación realizada sobre un sistema de referencia.

3.Transformar un vector expresado en coordenadas con respecto a


un sistema O’UVW, a su expresión en coordenadas del sistema
de referencia OXYZ.

4.Rotar y trasladar un vector con respecto a un sistema de


referencia fijo OXYZ.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 62
Ingeniería Mecatrónica
Matrices de transformación homogénea
Sus principales ventajas residen en su capacidad de representación
conjunta de posición y orientación y en la comodidad con la que se
puede realizar la composición de transformaciones.
Como su principal inconveniente presenta su alto nivel de redundancia
(necesita definir 12 componentes para sólo 6 grados de libertad). Esto
dificulta su implementación en computador.
Ángulos de Euler
Los ángulos de Euler, en cualquiera de sus modalidades, sólo son capaces de
representar orientación, y aunque permiten una notación compacta (sólo tres
números reales), son difíciles de manejar para composición de rotaciones y para
su aplicación sobre un vector.
Cuaternios
El cuaternio, como tal, sólo es capaz de representar la orientación relativa de un
sistema O’UVW con respecto a otro, a través del uso de cuatro componentes.
Sin embargo, es posible componer rotaciones junto con traslaciones de forma
bastante simple y computacionalmente económica.

Carlos Alberto Vera


Ing. Electrónico
Robótica Industrial 1 63
Ingeniería Mecatrónica
Carlos Alberto Vera
Ing. Electrónico
Robótica Industrial 1 64
Ingeniería Mecatrónica

También podría gustarte