Professional Documents
Culture Documents
La matriz C(q,q) llamada matriz centrífuga y de coriolis puede no ser única, pero el vector
C(q,q)q sí lo es. Una manera de obtener C(q,q) es a través de los coeficientes o símbolos de
Christoffel definidos como
Dónde denota el ij-esimo elemento de la matriz de Inercia M(q). De tal forma que el Kj-esimo
elemento de la matriz C(q,q) puede obtenerse de
Por lo tanto se calculan los simbolos de christoffel usando la ecuación 3. 24 y los elementos de
la matriz de Inercia definidos en 3. 23 con lo que se obtiene
De tal forma que los elementos de la matriz centrífuga y de coriolis C(q,q) se obtienen
utilizando la ecuación 3. 25 y los resultados de 3. 26 obteniendo así
Como el robot se desplaza en el plano horizontal x-y, la energía potencial resulta nula, esto es
U(q)=0, y ya que , entonces Con lo cual el modelo Dinámico del
robot experimental en su forma compacta es
Donde los elementos de la matriz de Inercia M(q) están definidos en 3. 23 y los elementos de
la matriz centrífuga y de coriolis están definidos en 3. 27 y
Matriz de rotación
Al despejar R obtenemos 1/R pero sabemos que en matrices (1/matriz) es igual a la inversa de
la matriz, recordando que la inversa de esta matriz es su transpuesta obtenemos:
Cinematica directa robot 2gdl
Donde
Simulación en Matlab
Para realizar la simulación en Matlab, como primer paso determinamos la nomenclatura que
utilizaremos para cada una de las variables, las cuales se muestran en la siguiente tabla.
Codigo de matriz de rotación
Codigo analisis cinemático del sistema
Codigo para 2gdl
Codigo para control PD
Codigo de simulación