La obtención del modelo dinámico de un manipulador juega un rol importante para la simulación del movimiento, el análisis de la estructura del manipulador y el diseño de los algoritmos de control. La simulación del movimiento de un manipulador permite probar estrategias de control sin necesidad de disponer físicamente del manipulador. El cálculo de las fuerzas y torques requeridos para la ejecución de los movimientos del robot proporciona información valiosa para el diseño de las juntas, transmisiones y actuadores.
El modelo dinámico de un robot consiste en una ecuación diferencial (ordinaria) vectorial en las posiciones, ya sean articulares q o cartesianas x, generalmente de segundo orden, pudiéndose expresar como:
En las expresiones anteriores el vector τ corresponde a las fuerzas y torques aplicados en las juntas por los actuadores. La ecuación (1) corresponde al modelo dinámico articular y la ecuación (2) al modelo dinámico cartesiano.
La fuerza resultante que actúa en un cuerpo rígido es igual a la tasa de cambio en el tiempo de su cantidad de movimiento lineal con respecto a un sistema de referencia inercial:
Donde vG es la velocidad del centro de masa del cuerpo rígido, ΣF es la fuerza resultante que actúa sobre el cuerpo rígido y P es la cantidad de movimiento lineal con respecto al sistema de referencia inercial. Dado que aG=v˙G, la ecuación anterior se puede escribir como
De la ecuación (3) se desprende un principio o teorema de conservación de la cantidad de movimiento:
Si la fuerza resultante en un sólido es cero, entonces P˙=0, lo cual implica que la cantidad de movimiento lineal del sólido se conserva, es decir, permanece constante.
El momento resultante (ΣMO) de las fuerzas externas que actúan en un cuerpo rígido con respecto a un punto fijo O en un sistema de referencia inercial, es igual a la tasa de cambio en el tiempo de la cantidad de movimiento angular alrededor de O:
donde HO es la cantidad de movimiento angular del cuerpo con respecto al mismo punto O. De la ecuación (5) se desprende también un principio de conservación de la cantidad de movimiento angular:
Si el momento resultante en un sólido con respecto a un punto fijo O es cero, entonces H˙O=0, lo cual implica que la cantidad de movimiento angular HO con respecto a O se conserva, es decir, permanece constante.
La ecuación (5) se puede escribir también haciendo que el punto O ahora se corresponda con la ubicación del centro de masa (G), es decir:
Donde ΣMG es la sumatoria de los momentos alrededor de G y HG la cantidad de movimiento angular alrededor del centro de masa.
Consideremos un cuerpo rígido modelado como un sistema de N partículas como el que se muestra en la figura. Las ecuaciones (3) y (5) son aplicables para este modelo. Si las N partículas son newtonianas, la cantidad de movimiento lineal y la cantidad de movimiento angular están dadas por:
Otra manera de abordar la dinámica de un cuerpo rígido (o partícula) es utilizar las ecuaciones de Euler-Lagrange. Dado un sistema mecánico de n grados de libertad, sus ecuaciones de movimiento se pueden obtener como sigue:
A qi y q˙i se les denomina coordenada generalizada y velocidad generalizada, de forma respectiva. Un conjunto de coordenadas generalizadas (q1,q2,⋯,qn) es aquel que describe de manera completa la posición de un sistema de n grados de libertad. Las velocidades generalizadas son las derivadas de las coordenadas generalizadas (q˙1,q˙2,⋯,q˙n).
La experiencia demuestra que dadas simultáneamente las coordenadas y velocidades generalizadas se determina completamente el estado del sistema y permite, en principio, predecir su movimiento futuro. Las relaciones entre las aceleraciones, las velocidades y las coordenadas se llaman ecuaciones de movimiento. \cite{landau}
El término τi corresponde a las fuerzas generalizadas aplicadas sobre el cuerpo rígido o sistema de cuerpos rígidos.
En la Figura Figure 1 se muestra un cuerpo rígido, el cual está rotando con una velocidad angular ω y donde la posición de la i-ésima partícula de masa mi con respecto al sistema de referencia Gx′y′z′ está dada por el vector ri/G. El sistema de referencia Gx′y′z′ está adherido al sólido y el sistema Oxyz es un sistema de referencia inercial.
Dado que la sumatoria de las masas de cada una de las partículas corresponde a la masa total del sólido, entonces el primer término de esta ecuación se puede expresar como:
a esta matriz se le denomina matriz de inercia o más comunmente tensor de inercia. En este caso el tensor de inercia describe la manera en que la masa está distribuida con respecto al sistema de referencia Gx′y′z′ adherido al sólido, así pues aún cuando el cuerpo se traslade o rote, el tensor de inercia permanece invariable. En secciones posteriores nos centraremos en cómo determinar cada uno de los componentes del tensor de inercia.
Considerando todo lo anterior, el tercer término de (13) se puede escribir como:
La energía potencial gravitatoria de un cuerpo rígido es una cantidad que depende de la masa, la gravedad y la posición del centro de masa. Se puede expresar como:
Donde m es la masa total del cuerpo rígido, g es un vector que define la aceleración de la gravedad en el sistema inercial y rG es un vector que describe la posición del centro de masa del cuerpo rígido en el sistema inercial.
El centro de masa es un punto hipotético de un sistema de partículas o de un sólido, tal que dicho sistema se comporta como si toda su masa estuviera concentrada en ese único punto. Es importante destacar que el centro de masa no siempre coincide con un punto material físico en el objeto. El centro de masa es el único punto en el centro de una distribución de masa en el espacio que tiene la propiedad de que los vectores de posición ponderados relativos a este punto suman cero.
Para un sistema de n partículas, cada una de masa mi y con una posición dada por ri, las coordenadas R del centro de masa deben satisfacer la condición:
Donde xi,yi,zi son las coordenadas de la ubicación de la partícula i cuya masa es mi.
Ejemplo.Calcule el centro de masa del sistema de partículas que se muestran en la Figura. Cada partícula tiene una masa de 0.25 kg. Las unidades de longitud de la rejilla son metros.
Las ecuaciones (36) se pueden generalizar para un cuerpo rígido, bajo la asunción de que un cuerpo rígido se puede considerar como un conjunto infinito de partículas cuyas distancias son invariables entre sí, así la sumatoria la podemos reemplazar por una integral, es decir:
En las ecuaciones anteriores los términos x~,y~,z~ denotan la ubicación del centro de masa del elemento diferencial utilizado para la integración. El diferencial de masa dm se puede expresar como:
En el caso general, la densidad podría no ser constante y depender de la ubicación, es decir ρ=ρ(x,y,z). Para la mayoría de situaciones en ingeniería, los componentes mecánicos están fabricados con materiales homogéneos (densidad constante), lo cual implica que el centro de masa coincidará con el centroide del volumen del sólido, de tal manera que las coordenadas del centro de masa se pueden determinar mediante:
Para cuerpos rígidos con forma de placas delgadas, de espesor uniforme y homogéneas, el centro de masa coincidirá con el centroide del área de la placa, así, las coordenadas del centro de masa se pueden determinar mediante:
Estas integrales de área se pueden plantear de varias maneras, todo depende de la elección del elemento diferencial. En la siguiente figura se muestran dos posibles opciones. Del lado izquierdo se utiliza un elemento diferencial cuya área es dA=dxdy, y cuyas coordenadas centroidales son x~=x y y~=y. Del lado derecho se utiliza un elemento diferencial cuya área es dA=bhxdx, sus coordenadas centroidales son x~=x y y~=2bhx, observe que este es un elemento diferencial rectangular cuya base es dx, y siendo su altura aquella definida por la hipotenusa del triángulo, cuya función es y(x)=bhx. Naturalmente, su coordenada centroidal y~ está dada por la mitad del valor de y(x).
Aquí podemos utilizar cualquiera de los dos elementos diferenciales. Sólo debemos tener en consideración que si se utiliza el elemento diferencial de (a), entonces resultará una integral doble, que deberemos integrar en los límites definidos por el área triangular. Si utilizamos el elemento diferencial (b) se tendrá una integral simple, que deberemos integrar en los límites definidos para la dirección en x, es decir, entre 0 y b. Para ejemplificar vamos a proceder de ambas maneras. \
Observe que los resultados de las integrales son exactamente los mismos que obtuvimos con la manera anterior. La elección del elemento diferencial dependerá completamente de cuál le resulte más cómodo de plantear y resolver. En el caso de que se tenga una placa con densidad variable ρ(x,y), aquí sí o sí tendrá que usar una integral doble para determinar el centro de masa.
Ejemplo. Calcule el centro de masa del sólido mostrado en la figura. Considere que está conformado de un material homogéneo.
Dado que ρ es constante, entonces el centro de masa coincidirá con el centroide del volumen del sólido, el cual podemos determinarlo mediante las siguientes ecuaciones:
La formulación de las integrales dependerá del elemento diferencial que se seleccione. Por ejemplo, si utilizamos un elemento diferencial como el mostrado en la Figura Figure 6, es sencillo observar que las coordenadas centroidales de este elemento son: x~=x,y~=y,z~=z, y que el volumen diferencial está dado por dV=dxdydz.
Se debe tener cuidado con el orden de integración y los límites correspondientes; puede verificar fácilmente que podríamos primero integrar con respecto a y, seguido de x y finalmente z, y daría exactamente lo mismo, es decir:
Otra manera de abordar este problema es utilizando un elemento diferencial como el mostrado en la Figura Figure 7. Note que en este caso el volumen del elemento y sus coordenadas centroidales están dadas por:
La ventaja de usar este elemento diferencial es que las integrales a resolver son integrales simples, aunque ya habrá notado que ubicar las coordenadas centroidales del elemento implica un poco más de trabajo que en el primero.
Un cuerpo compuesto es aquel que está formado por la unión de dos o más cuerpos simples. Estos cuerpos simples pueden ser de diferentes formas y tamaños, y al unirse forman un cuerpo más complejo. Por ejemplo, un cuerpo compuesto puede estar formado por la unión de varios cubos, cilindros o prismas.
Para calcular el centro de masa de un cuerpo compuesto, es necesario dividir el cuerpo en una n cantidad de componentes simples, de los cuales sea sencillo determinar por separado su masa y centro de masa. Luego, las coordenadas del centro de masa estarán dadas por las siguientes expresiones:
Donde x~i,y~i,z~i corresponden a las coordenadas del centro de masa del i−ésimo cuerpo simple, y mi corresponde a su masa. Expresiones similares se pueden plantear en el caso de que el sólido sea homogéneo (mismo material o misma densidad constante):
Ejemplo. En la figura se muestra un sólido compuesto por dos porciones de placa cuadrangulares. Calcule el centro de masa del cuerpo compuesto. Considere que las placas son delgadas y de espesor uniforme. La masa de la sección 1 de 0.2 kg, y la sección 2 tiene una masa de 0.15 kg.
El momento de inercia de masa de un cuerpo rígido (o sistema de partículas) es una cantidad que determina el par necesario para una aceleración angular deseada alrededor de un eje de rotación, similar a cómo la masa determina la fuerza necesaria para una aceleración deseada. Depende de la distribución de masa del cuerpo y del eje elegido, un momento de inercia más grande implica que se requiere más torque para cambiar la velocidad de rotación del cuerpo en una cantidad determinada.
El momento de inercia (I) de una masa puntual (m) con respecto a un eje se define como el producto de la masa por la distancia al eje (d) elevada al cuadrado, es decir.
El momento de inercia de cualquier otra entidad se construye a partir de esa definición básica. Por ejemplo, para un sistema de partículas la definición anterior se puede expresar como:
Donde ri corresponde a la distancia de cada partícula de masa mi al eje. Si introducimos un sistema de referencia cartesiano xyz y calculamos los momentos de inercia con respecto a cada uno de sus ejes, se tiene que:
El momento de inercia de una distribución continua de masa (sólido rígido) se encuentra utilizando integración en lugar de la sumatoria. Si el sólido se divide en un elemento infinitesimal de masa dm, y si r es la distancia desde el elemento de masa al eje de rotación, el momento de inercia se puede determinar como sigue:
Tome en cuenta que estas integrales se efectúan sobre la distribución de la masa. La formulación de las integrales a calcular depende mucho de cómo se establezca el elemento diferencial de masa y de la densidad del sólido.
Ejemplo. Calcule el momento de inercia de masa de la placa rectangular con respecto a los sistemas xyz y x1y1z1. Considere que la placa es de espesor delgado y uniforme, y que además es homogénea. El sistema x1y1z1 está ubicado en el centro de masa de la placa.
Si se conoce el momento de inercia de un cuerpo respecto de un eje que pasa por su centro de masa, entonces se puede también determinar fácilmente el momento de inercia con respecto de cualquier otro eje que sea paralelo. En el esquema mostrado en la Figura Figure 10 se tienen dos sistemas referencia, uno de estos tiene su origen en el centro de masa del cuerpo rígido.
Donde rx es la distancia más corta desde la masa diferencial dm hasta el eje x, observe que en este caso rx=y=y1+d, entonces podemos plantear la integral anterior como:
El primer término de esta expresión corresponde justamente al momento de inercia del sólido con respecto al eje x1 que pasa por su centro de masa, es decir:
La integral del segundo término corresponde al primer momento de masa, el cual cuando se determina con respecto al centro de masa es cero (recordar la definición de centro de masa), por lo tanto:
Este resultado es lo que se conoce de forma extendida como el teorema de los ejes paralelos. Observe que si conocemos el momento de inercia con respecto al eje x1 (que pasa por el centro de masa), entonces sería muy sencillo determinar el momento de inercia con respecto a cualquier otro eje x que sea paralelo, puesto que sólo necesitaríamos conocer la masa total del sólido y la distancia perpendicular entre el eje centroidal y el otro eje paralelo. Este procedimiento se puede replicar para cualquiera de los otros ejes cartesianos, de forma un poco más general, podemos expresar el teorema de los ejes paralelos de la siguiente manera:
Y enunciarlo de la forma habitual: el momento de inercia de un cuerpo rígido respecto a cualquier eje u que sea paralelo a un eje u′ que pasa por su centro de masa, es igual al momento de inercia con respecto al eje u′ más el producto de la masa total del cuerpo por el cuadrado de la distancia perpendicular entre los dos ejes.
El teorema de los ejes paralelos facilita los cálculos de los momentos de inercia para sólidos con geometrías simples, dado que evita en muchas situaciones la necesidad de integración, y en su lugar se utilizan las tablas de momento de inercia de masa en conjunto con el teorema. En la siguiente sección veremos también que es muy recurrido para cuando tengamos que determinar los momentos de inercia de sólidos compuestos.
Ejemplo. Utilice el teorema de los ejes paralelos para determinar los momentos de inercia con respecto a los ejes del sistema xyz de la placa rectangular mostrada en la Figura. Considera que la placa es de espesor delgado y uniforme, y que además es homogénea.
Donde dxx1 es la distancia perpendicular entre los ejes x y x1, que en este caso es la mitad de la altura de la placa. El momento de inercia con respecto al eje x1 que pasa por el centro de masa está dado por:
Para muchos sólidos compuestos, es posible dividirlos en partes más simples cuyos momentos de inercia sean fácilmente calculables. Una vez determinados estos momentos de inercia de cada parte simple, se pueden sumar para calcular el momento de inercia del sólido compuesto. Por ejemplo, el sólido de la Figura Figure 12 se puede dividir en las tres partes simples que se observan (dos porciones rectangulares y una porción triangular). Así pues, el momento de inercia del sólido compuesto con respecto al eje x se puede determinar como sigue:
Donde (Ixx)i denota el momento de inercia de masa de la porción i con respecto al eje x. Expresiones análogas se pueden plantear para Iyy e Izz, a saber:
De manera general, para un sólido compuesto por n partes simples, los momentos de inercia con respecto a los ejes de un sistema cartesiano xyz se pueden determinar mediante:
El término (Ixx)i es el momento de inercia de la parte i con respecto al eje x, y de manera similar para los correspondientes de y y z. Cada uno de los términos de las sumatorias anteriores se pueden determinar mediante el teorema de los ejes paralelos, es decir:
En lo anterior, Iˉxixi corresponde al momento de inercia de la parte i con respecto al eje xi que pasa su centro de masa, mi es la masa de dicha parte y dxxi es la distancia más corta entre los ejes x y xi. Y así de manera análoga para los otros dos ejes.
Ejemplo.En la figura se muestra un sólido compuesto por dos porciones de placa cuadrangulares. Determina los momentos de inercia con respecto a los ejes del sistema mostrado. Considera que las placas son delgadas y de espesor uniforme. La masa de la porción 1 es de 0.2 kg y la de la porción 2 es de 0.15 kg.
El momento de inercia del cuerpo compuesto corresponde a la suma de los momentos de inercia de cada una porciones, con respecto a cada uno de los ejes correspondientes.
El momento de inercia Ixx se puede determinar mediante:
Donde (Ixx)1 y (Ixx)2 son los momentos de inercia de masa con respecto al eje x, de cada una de las porciones, respectivamente. Para (Ixx)1 se tiene que:
Ejemplo.En la Figura se muestra un sólido fabricado en un tipo de acero cuya densidad es ρ=7850 kg/m3. Calcule los momentos de inercia Ixx, Iyy e Izz.
Los productos de inercia de masa son cantidades utilizadas para describir la distribución de la masa en un sólido en movimiento. Estos productos son esenciales para entender el comportamiento de un cuerpo cuando se somete a rotación alrededor de un eje en un sistema de coordenadas tridimensional. Los productos de inercia pueden entenderse también como una medida de la simetría del cuerpo con respecto a un sistema de referencia.
Comenzaremos con los productos de inercia de un sistema de partículas ubicadas en el espacio, los cuales pueden determinarse mediante las siguientes expresiones:
Donde xi,yi,zi corresponden a las coordenadas de la ubicación de cada partícula de masa mi. En la Figura Figure 16 se muestra un sistema de dos partículas ubicadas en el plano xy, distribuidas de diversas maneras. Primero, de las ecuaciones anteriores se puede verificar de forma sencilla que Ixz=Iyz=0, dado que para ambas partículas zi=0. Para el caso de la Figura Figure 16a) se puede observar que el producto de inercia Ixy está dado por:
Si ambas partículas poseen masas de igual magnitud, entonces Ixy=0, dado que en dicho caso existiría también una simetría con respecto al plano xz. Esto nos lleva a un par de conclusiones que podemos verificar en los ejemplos que se resolverán posteriormente:
Para el sistema de la Figura Figure 16b) se puede verificar que:
Lo visto anteriormente para un sistema de partículas, se puede generalizar para el caso de un sólido rígido mediante el uso de las siguientes expresiones:
Ejemplo.En la Figura se muestra una placa plana homogénea de forma rectangular, con espesor delgado y uniforme. Calcule los productos de inercia de masa con respecto a los sistemas xyz y x1y1z1 que se muestran.
Debido a que el plano xy es un plano de simetría para la placa, entonces los productos de inercia Ixz e Iyz son ambos cero. El producto de inercia Ixy se puede determinar como sigue:
Observe Ixy es una cantidad negativa, lo cual se puede inferir de la figura, dado que la masa de la placa se distribuye toda en el primer cuadrante del plano xy.
Note que todos los productos de inercia en el sistema de referencia x1y1z1 son cero, debido a que todos los planos de dicho sistema son planos de simetría para la placa rectangular, entonces:
Si se conocen los productos de inercia de un sólido respecto de un sistema de referencia que pasa por su centro de masa, entonces se pueden también determinar fácilmente los productos de inercia con respecto de cualquier otro sistema de referencia que sea paralelo. En la Figura Figure 18 se muestra una placa plana, delgada y homogénea, en la cual se tienen dos sistemas referencia, teniendo uno de estos su origen en el centro de masa del cuerpo rígido. De la Figura se puede observar que tanto Ixz como Iyz son cero, debido a que al plano xy es un plano de simetría.
Las integrales del segundo y tercer término corresponden al primer momento de masa, el cual cuando se determina con respecto al centro de masa es cero (recordar la definición de centro de masa), por lo tanto:
La integral del último término corresponde al producto de inercia x1y1 con respecto al sistema de referencia que pasa por el centro de masa, es decir:
Expresiones análogas se pueden formular para los productos de inercia Ixz e Iyz en el caso de que se tenga un sólido tridimensional asimétrico con respecto a los planos, a saber:
Ejemplo. En la Figura se muestra una placa plana homogénea de forma rectangular, con espesor delgado y uniforme. Utilice el teorema de los planos paralelos para determinar el producto de inercia Ixy.
Donde Iˉx1y1 es el producto de inercia con respecto al sistema x1y1z1 ubicado en el centro de masa de la placa rectangular; sin embargo, es sencillo notar que todos los planos del sistema {1} son planos de simetría, lo cual implica que Iˉx1y1=Iˉx1z1=Iˉy1z1=0. Además, se puede observar que xˉ=b/2 y yˉ=h/2
Observe que este resultado coincide con el que se obtuvo mediante integración en un ejemplo anterior.
6.1.5.2Productos de inercia de cuerpos compuestos¶
Los productos de inercia de un cuerpo compuesto de n partes simples, con respecto a un sistema de referencia xyz, se pueden determinar calculando por separado los productos de inercia de cada una de las partes y sumándolos, es decir:
El término (Ixy)i es el producto de inercia Ixy de la parte i con respecto al sistema xyz, y de manera similar para los correspondientes productos de inercia Ixz e Iyz. Cada uno de los términos de las sumatorias anteriores se pueden determinar mediante el teorema de los planos paralelos revisado en la sección anterior, es decir:
En lo anterior, Iˉxiyi corresponde al producto de inercia de la parte i con respecto al sistema xiyizi que pasa su centro de masa, mi es la masa de dicha parte, xˉi y yˉi corresponden a las coordenadas en x y y del CDM de la parte i. Y así de manera análoga para los otros dos productos de inercia.
Ejemplo.En la Figura se muestra un cuerpo compuesto por tres partes rectangulares, de espesor delgado y uniforme. Se sabe que m1=0.121 kg, m2=0.104 kg y m3=0.226 kg. Calcule los productos de inercia del cuerpo compuesto con respecto al sistema xyz mostrado.
Puesto que la placa es delgada y uniforme, el plano xy es un plano de simetría, y en consecuencia Ixz=0 e Iyz=0. El producto de inercia Ixy está dado por la suma de los productos de inercia de cada porción, es decir:
Se debe tener en cuenta que, por la simetría de los sistemas de referencia ubicados en el centro de masa, los productos de inercia Iˉx1y1, Iˉx2y2 y Iˉx3y3 son cero. Sumando los productos de inercia calculados se tiene que:
6.2Dinámica de manipuladores seriales: formulación de Euler-Lagrange¶
En esta sección veremos cómo obtener el modelo dinámico de un manipulador serial utilizando las ecuaciones de Euler-Lagrange. Una de las ventajas de esta formulación es que las ecuaciones de movimiento pueden ser obtenidas de manera sistemática, independientemente del sistema de referencia.
El primer paso es identificar un conjunto de coordenadas generalizadas que sea apropiado para analizar el manipulador, en este texto se utilizarán las variables articulares de posición del manipulador como coordenadas generalizadas (q1,q2,q3,⋯,qn), asumiremos también que estás posiciones articulares son definidas y medidas de acuerdo con los visto en el capítulo de Cinemática directa. Una vez que se elige un conjunto de coordenadas generalizadas apropiadas, se procede a formar el lagrangiano del manipulador, recordar que este es una función escalar dada por la diferencia de la energía cinética y potencial:
Asumimos que la energía potencial P es debida únicamente a fuerzas conservativas, como la energía potencial asociada con la gravedad y la almacenada en resortes. En secciones previas vimos cómo calcular tanto la energía cinética como la potencial de un cuerpo rígido, ahora en las secciones posteriores estableceremos expresiones adaptadas para calcular estas energías para un eslabón que pertenece a un manipulador serial.
Con el lagrangiano ya definido, procedemos a calcular las ecuaciones de movimiento de Euler-Lagrange:
Para un manipulador de n grados de libertad se obtendrán n ecuaciones diferenciales de segundo orden que modelan su comportamiento dinámico. Este comportamiento se puede simular si resolvemos el sistema de ecuaciones diferenciales, lo cual usualmente se hará mediante métodos numéricos. Naturalmente este modelo dinámico se puede utilizar también para el diseño e implementación de algoritmos de control.
Un eslabón de un manipulador serial es un cuerpo rígido y por lo tanto se puede utilizar la ecuación (11) para determinar su energía cinética, aquí estableceremos una versión ligeramente modificada, únicamente con el propósito de sistematizar un poco la obtención de las ecuaciones, así pues para el i-ésimo eslabón de un manipulador serial su energía cinética se puede determinar mediante:
Donde mi es la masa del eslabón, vGi es la velocidad lineal del centro de masa del eslabón i, ωi es la velocidad angular del eslabón i y el término Ii corresponde al tensor de inercia del eslabón. Es importante tener en cuenta que los vectores vGi y ωi están expresados en el sistema de la base {0}.
El tensor de inercia Ii es una matriz simétrica que caracteriza la inercia rotacional de cada eslabón con respecto a un sistema de referencia paralelo al de la base, pero ubicado en el centro de masa del eslabón i. Este tensor se puede formar de manera más conveniente, si en primera instancia se determina el tensor Iii′, es decir, el tensor de inercia del eslabón i descrito en un sistema de referencia {i′} ubicado en su centro de masa y que es paralelo al sistema {i} del eslabón.
Así, Iii′ es una matriz constante y se puede relacionar con Ii mediante la siguiente transformación de similitud:
Donde mi es la masa de dicho eslabón, g es el vector que describe la aceleración de la gravedad en el sistema de la base y rGi es un vector que describe la ubicación del centro de masa del eslabón i con respecto al sistema de la base.
Una vez que se han calculado las energías cinética y potencial de cada uno de los eslabones que conforman el manipulador, se procede a sumarlas para determinar la energía total en cada caso. La energía cinética total está dada por:
La velocidad del centro de masa vGi se puede calcular derivando con respecto al tiempo el vector de posición del centro de masa rGi.
El vector rGi se puede calcular de manera más sencilla si primero se forma el vector rGii, es decir, la posición del centro de masa del eslabón i descrita en el sistema de referencia {i}. Tome en cuenta que rGii es un vector cuyas componentes son constantes. Luego, rGi se puede determinar mediante una transformación de coordenadas:
Calcular la energía potencial de cada uno de los eslabones.
El vector de gravedad g es un vector que determina la dirección de la aceleración de la gravedad en el sistema inercial de la base {0}.
El vector rGi es el vector que describe la ubicación del centro de masa del eslabón en el sistema {0}. En el listado previo se hace una sugerencia de cómo calcularlo.
Ejemplo. Obtenga el modelo dinámico del manipulador P mostrado en la figura. El eslabón 1 tiene una masa m1 y su centro de masa coincide con el origen de coordenadas del sistema {1}.
Ejemplo.Obtenga el modelo dinámico del manipulador PR mostrado en la Figura. Considere que tanto el eslabón 1 como el 2 son simétricos con respecto al menos dos planos del sistema ubicado en su centro de masa. La longitud del eslabón 2 es l2.
Dado que la primera articulación es traslacional, entonces ω1=0, y el término de la energía cinética rotacional se hace cero. El vector rG1 está dado por:
Dado que el eslabón 2 es simétrico con respecto al menos dos planos del sistema de su centro de masa, entonces el tensor de inercia I22′ tiene la forma:
La matriz M(q) se denomina matriz de inercia (o matriz de masas), es una matriz de n×n que caracteriza cómo la masa y su distribución afectan la relación de las fuerzas y aceleraciones articulares. Es una matriz simétrica y definida positiva, posteriormente abordaremos con más detenimiento estas propiedades.
La energía potencial P no tiene una forma particular como en el caso de la energía cinética, pero se sabe que depende de las posiciones articulares q. El langrangiano, definido en secciones previas, se puede escribir entonces como:
La ecuación (252) corresponde a la dinámica de un manipulador de n grados de libertad. C(q,q˙)q˙ es un vector de n elementos denominado vector de fuerzas centrífugas y de Coriolis, g(q) es un vector de n elementos que contiene las fuerzas y pares gravitacionales. El vector τ es el vector de fuerzas y pares externos.
La matriz de fuerzas centrífugas y de Coriolis C(q,q˙) puede no ser unica, pero el vector C(q,q˙)q˙ si que lo es. Cada elemento cij de la matriz C(q,q˙) se puede determinar mediante:
Donde mij denota el ij-ésimo elemento de la matriz de inercia.
Ejemplo.Obtenga el modelo dinámico en forma compacta del manipulador RP mostrado en la figura. Considere que ambos eslabones son simétricos con respecto al menos dos planos del sistema ubicado en su centro de masa.
Hasta ahora hemos trabajado con la obtención del modelo dinámico de un manipulador serial, considerando únicamente lo que concierne a la estructura física de los eslabones. En esta sección vamos a abordar y desmenuzar el término τ que aparece en la ecuación del modelo dinámico.
El vector τ agrupa a todas las fuerzas externas generalizadas (no conservativas) que actúan sobre el manipulador, entre las cuales podemos identificar las fuerzas o torques que ejercen los actuadores, las fuerzas externas debidas a restricciones, contactos o a la manipulación de objetos por el elemento terminal, así como las fuerzas de fricción. Es común que τ se exprese como una combinación de cada tipo de fuerzas:
Supongamos que se tiene un manipulador serial sujeto a una fuerza F1 y un torque μ1 aplicados en el punto B1. Si tanto F1 como μ1 se expresan en el sistema de referencia de la base, entonces es posible proyectarlos en la dirección de las coordenadas generalizadas del manipulador, mediante la siguiente ecuación:
Donde JB1 es la matriz jacobiana, (Jv)B1 es el jacobiano de velocidad lineal y (Jω)B1 el jacobiano de velocidad angular, en todos los casos calculadas en el punto B1 y descritas en el sistema de la base. Puede revisar la sección Section 5.6.2 para recordar cómo determinar las matrices jacobianas asociadas con un punto del manipulador.
La ecuación anterior se puede reescribir para cuando se tienen varias fuerzas y torques aplicados en diversas ubicaciones del manipulador serial, así pues, para una N cantidad de fuerzas y torques aplicados en un manipulador serial se tiene:
En la mayoría de los casos únicamente se aplican fuerzas o torques en el elemento terminal del manipulador, bajo esta consideración τext se calcula como sigue:
La fricción es un fenómeno que aparece principalmente asociada con las articulaciones y sus componentes (rodamientos, engranes, etc.). Siempre habrá fricción en un manipulador real y afecta su comportamiento dinámico. Un modelo simplificado de fricción puede establecerse considerando únicamente la fricción viscosa y la fricción de Coulomb, tal como se muestra a continuación:
Donde A es una matriz de n×n que transforma las señales/entradas de control u en el torque/fuerza que ejerce cada actuador, es decir, esta matriz concentra las características de cada uno de los actuadores. Si los actuadores están desacoplados, A es una matriz diagonal.
Ejemplo. Determine la fuerza generalizada τ para el manipulador R mostrado en la Figura Figure 24, considerando que está sujeto a una carga externa F aplicada en su extremo, de magnitud constante y que permace siempre en dirección vertical hacia abajo, tal como se esquematiza.
6.4Obtención del modelo dinámico utilizando Python¶
En esta sección veremos cómo obtener, utilizando Python y la librería SymPy, el modelo dinámico de un manipulador serial mediante la formulación de Euler-Lagrange.
Primero, vamos a procurar comprender cómo podemos obtener, de forma sistematizada, el modelo dinámico de un manipulador. Comenzaremos teniendo en cuenta que para determinar cada ecuación de movimiento de Lagrange, necesitamos conocer el lagrangiano (L) del manipulador, y para calcular este requerimos conocer tanto la energía cinética como la energía potencial de cada uno de los eslabones que conforman el manipulador. Para calcular estas energías necesitamos determinar posición y velocidad del centro de masa, velocidad angular del eslabón, el tensor de inercia del eslabón y el vector de gravedad. Y así podríamos seguir describiendo lo que se requiere para formar cada uno de los términos subsiguientes. En la Figura se muestra un diagrama que pone de manifiesto algunos de los términos o cantidades requeridas para formar el modelo dinámico.
En los niveles más bajos de cada una de las ramas del diagrama de árbol mostrado se puede observar que se requieren las siguientes cantidades:
Las matrices de transformación Ti0
Las matrices de rotación Ri0
Los vectores de posición rGii
Los tensores de inercia Iii′
Las velocidades angulares ωj−1,jj−1
Las masas de los eslabones mi
El vector de gravedad g
Primero, es importante notar que Ri0 es una submatriz de Ti0, en consecuencia, si calculamos Ti0 tendríamos también a Ri0. De la cinemática directa sabemos que cada matriz Ti0 se puede calcular mediante composición de matrices de la siguiente manera:
Es decir, necesitamos determinar previamente cada una de las matrices de la forma Tii−1 para el manipulador. Recuerde que estas matrices se obtienen directamente al sustituir los parámetros de Denavit-Hartenberg del manipulador en la matriz dada por la ecuación (9). Así pues, lo primero que notamos es que necesitamos conocer los parámetros de Denavit-Hartenberg, se asumirá que estos parámetros se proporcionarán como datos de entrada.
Los vectores de posición rGii describen la ubicación del centro de masa de cada uno de los eslabones, en el sistema de referencia {i}. Estos vectores no se pueden calcular a partir de otros datos, se asumirá que son datos de entrada que deberán ser proporcionados.
Los tensores de inercia Iii′ describen las propiedades de inercia de cada eslabón con respecto a un sistema de referencia ubicado en su centro de masa y paralelo al sistema {i}. Consideraremos que estas matrices se proporcionarán como datos de entrada.
El término ωj−1,jj−1 corresponde a la velocidad angular de cada eslabón ((j)) con respecto al eslabón inmediatamente anterior (j−1), descrita en el sistema de referencia adherido a ese eslabón previo {j−1}. Las velocidades angulares ωj−1,jj−1, de acuerdo con lo visto en la sección Section 5.2 tienen siempre la forma:
ωj−1,jj−1=⎣⎡00q˙j⎦⎤;en el caso de que la junta j sea revoluta
Es decir, todo lo que necesitamos es saber el tipo de cada una de las juntas que conforman el manipulador, asumiremos entonces que esto deberá ser un dato de entrada.
Tanto la masa de los eslabones mi, como el vector de gravedad g, son cantidades que no se pueden determinar a partir de algún otro dato, así que asumiremos que se proporcionarán como datos de entrada.
De acuerdo con lo visto hasta ahora, podemos establecer que se requieren al menos los siguientes valores conocidos (o datos de entrada) para poder comenzar con el cálculo del modelo dinámico:
En la Figura se muestra una placa delgada, de espesor uniforme y homogénea, con forma semicircular de radio R. Utiliza integración para determinar: a) la ubicación del centro de masa, b) los momentos de inercia Ixx, Iyy y c) el producto de inercia Ixy.
Utiliza el teorema de ejes paralelos para calcular el momento de inercia de la placa semicircular (ver Figure 25) con respecto a un eje x′ que pasa por el centro de masa y paralelo al eje x de la figura.
En la Figura se muestra una placa delgada, de espesor uniforme y homogénea. Se sabe que posee una densidad ρA=40kg/m2. Utilizando integración calcule:
El componente mecánico mostrado en la Figura está fabricado con una lámina de espesor delgado (3 mm) y uniforme, el material de la lámina tiene una densidad ρ=2700 kg/m3. El orificio circular tiene un radio de 50 milímetros. Calcula, a) la ubicación del centro de masa y b)el tensor de inercia con respecto al sistema mostrado.
En la figura se muestra una placa compuesta delgada y de espesor uniforme, está conformada por dos secciones de diferente material unidas rígidamente. Se sabe que m1=0.130 kg y m2=0.452 kg. Las unidades de longitud son milímetros. Calcule a) el centro de masa, b) los momentos de inercia y c) los productos de inercia.
En la figura se muestra una placa compuesta delgada y de espesor uniforme, está conformada por dos secciones de diferente material unidas rígidamente. Se sabe que m1=0.152 kg y m2=0.265 kg. Calcule a) el centro de masa, b) los momentos de inercia y c) los productos de inercia. Las unidades de longitud son milímetros.
En la figura se muestra una placa compuesta delgada y de espesor uniforme, está conformada por dos secciones de diferente material unidas rígidamente. Se sabe que ρ1=10.8 kg/m2 y ρ2=31.4 kg/m2 kg. Calcule a) el centro de masa, b) los momentos de inercia y c) los productos de inercia. Las unidades de longitud son milímetros.
Obtenga el modelo dinámico del manipulador PP mostrado en la Figura Figure 32. Considere que las masas de los eslabones son m1 y m2. El CM1 está ubicado a una distancia lc1 del origen de {1}, y el CM2 coincide con el origen de {2}.
Obtenga el modelo dinámico del manipulador PP mostrado en la Figura Figure 33. Considere que las masas de los eslabones son m1 y m2. El CM1 está ubicado a una distancia lc1 del origen de {1}, tal como se esquematiza, y el CM2 coincide con el origen de {2}.
Obtenga el modelo dinámico del manipulador RP mostrado en la Figura Figure 34. Las masas de los eslabones son m1 y m2. Los tensores de inercia expresados en un sistema ubicado en el centro de masa de cada eslabón están dados por:
Obtenga el modelo dinámico del manipulador PR mostrado en la Figura. Las masas de los eslabones son m1 y m2. Considere que el CDM del eslabón 1 coincide con el origen de coordenadas del sistema {1}. La longitud total del eslabón 2 es l2. Los tensores de inercia expresados en un sistema ubicado en el centro de masa de cada eslabón están dados por:
Obtenga el modelo dinámico del manipulador RP mostrado en la figura. Las masas de los eslabones son m1 y m2. Considere que los tensores de inercia Ii están dados por:
Obtenga el modelo dinámico del manipulador RR mostrado en la figura. Las masas de los eslabones son m1 y m2. Considera que los tensores de inercia Iii′ son matrices diagonales.