cinematica inversa

Fundamentos de robótica
cinematica inversa

Cinemática Inversa I
La cinemática inversa más sencilla es la que se aplica al brazo robot tipo SCARA y brazo robot cilíndrico. En el brazo Scara tenemos que resolver los dos ángulos de las articulaciones. En este tipo de brazos el eje Z no interviene en la cinemática inversa porque es un resultado en sí mismo. Desde elpunto de vista del cálculo sólo tenemos en cuenta los ejes X e Y,  y la longitud de las articulaciones.

El triángulo formado por LongBrazo, LongAntBr e Hipotenusa suele ser del tipo irregular, sobre todo si los dos catetos (LongBrazo y LongAntBr) no son iguales. Para resolver los ángulos de este tipo de triángulo hay que aplicar el Teorema del Coseno.
Observa que en las fórmulastrigonométricas se usa la función arcocoseno "Acos()" y un tipo de arcotangente llamado "Atan2()". No es lo mismo Atan(Y/X) que Atan2(Y, X).

Se diferencia la una de la otra, además de la sintaxis, en que Atan2(), dependiendo de los signos contenidos en los valores X e Y tiene presente el cuadrante en el que se encuentra y puede recorrer los cuatro cuadrantes. Por contrapartida la función Atan() sólo tieneefecto en los cuadrantes 1 y 4. Comprueba que tu lenguaje de programación contiene la función Atan2() porque si no los datos no serán correctos.
En todos los lenguajes de programación las operaciones y los resultados de las funciones trigonométricas son siempre en radianes. Si queremos dar la información de los ángulos en el monitor es más cómodo hacerlo en grados "normales" llamados -gradossexagesimales- (se llama así porque cada grado son 60 minutos y a su vez, cada minuto son 60 segundos). Pasar radianes a grados sexagesimales se hace multiplicando el resultado en radianes por 180/Pi(57.29577951...). Y viceversa, para pasar grados sexagesimales a radianes hay que multiplicar por Pi/180 (0.017453292...). En el código fuente podrás ver ejemplos de estas conversiones según las necesidadesdel programa.

Los nombres de las variables que verás en el código fuente también están en la imagen que ves aquí arriba para que sepas de dónde viene cada una de las fórmula trigonométrica en las que además viene con el ajuste para situarlo en una zona de la pantalla. La aparente complejidad del programa es debido a que tenemos que situar esos puntos en la pantalla para formar mediante doslíneas el brazo tipo Scara de 2GL (GL= Grado de Libertad). En el monitor el eje X se corresponde con el plano que estamos acostumbrados en matemáticas, pero el eje Y no comienza en la esquina inferior izquierda, sino en la parte superior izquierda. Por esta razón en el código fuente interviene la variable BaseY al comienzo de la cinemática inversa.
 
.
WindowTitle "Cinematica Inversa para brazorobot SCARA."
Declare Sub InverseKDeclare Sub DibujaBrazoScreen 19         ' Ventana de 800x600.
Cls    
Dim Shared As Double   pi, grad, rad, Xaux, Yaux, x, y, AngAntBr, AngBrazo      
Dim Shared As Integer  BaseY, BaseX, LongBrazo, LongAntBrDim Shared As String   Tecla
pi   = Atn(1)*4
rad  = pi/180
grad = 180/pi
BaseX  = 400      ' Punto X Base (hombro)  Situamos el brazo en pantalla.
BaseY = 300      ' punto Y Base (hombro)
LongBrazo  = 150  ' Longitud Brazo.        Puedes modificar las longitudes del brazo o antebrazo.     
LongAntBr  = 150  ' Longitud AnteBrazo.
x=(150)           ' Posicion Inicial X.    Damos las coordenadas iniciales de la punta del brazo.
y=(150)+BaseY     ' Posicion Inicial Y.    Se puede modificar los valores que están dentro del paréntesis.
                 '                        Procurar que esté dentro del área de trabajo.
Tecla=" "
While Tecla<>Chr(27) And Tecla<>Chr(13) And Tecla<>Chr(255)+"k"

   Locate 35,33: Print "Pulsa W S A D para mover el Brazo."
   Locate 36,35: Print "Para salir pulsa Esc o Enter."

   InverseK
   If Tecla <> "" Then    ' Sólo cuando se pulsa una tecla dibuja el brazo.
 ...