INSTITUTO TECNOLÒGICO DE MAZATLAN - Profe Saul

El punto central de la muñeca del robot corresponde al origen del sistema (S5):O5. Por su parte, el punto final del robot será el origen del sistema (S6): O6.Enseguida se utilizaran los vectores:Pm = O0__O5Pr = O0__O6Que van desde el origen del sistema asociado a la base del robot (S0)hasta lospuntos centro de la muñeca y fin del robot, respectivamente.puesto que la dirección del eje Z6 debe coincidir con la de Z5 y la distancia entreO5 y O6 medida a lo largo de Z5 es precisamente d4 = I4, se tendrá que:Pr = ( Px, Py, Pz ) (exp)TEl director Z6 es el vector A correspondiente a la orientación deseada Z6 = ( Ax,Ay, Az ) (exp) T e I4 es un parámetro asociado con el robot. Por lo tanto, lascoordenadas del punto central de la muñeca ( Pmx, Pmy, Pmz ) son fácilmenteobtenibles.Es posible, mediante un método geométrico, por ejemplo, calcular los valores de (q1, q2, q3 ) que consiguen posicionar el robot en el Pm deseado.Quedan ahora obtener los valores de q4, q5, y q6 que consiguen la orientacióndeseada. Para ello denominando 0R6 a la submatriz de rotación de 0T6 se tendrá:0R6 = ( n o a ) = 0R3( 3R6 )Donde 0R6 es conocida por la orientación deseada del extremo del robot, y 0R3definida por:0R3 = 0A1 ( 1A2 ) ( 2A3 )También lo será a partir de los valores ya obtenidos de q1, q2 y q3. Por lo tanto:3R6 = ( Rij ) = ( 1 / 0R3 ) ( 0R6 ) = ( 0R )(exp)T ( n o a )Tendrá sus componentes numéricas conocidas.Por otra parte, 3R6 corresponde a una submatriz (3X3)de rotación de la matriz detransformación homogénea 3T6 que relaciona el sistema (S3) con el (S6), por lotanto:3R6 = 3R4 ( 4R5 )( 5R6 )48