4.-Tarea Académica N4 G1 PDF
4.-Tarea Académica N4 G1 PDF
4.-Tarea Académica N4 G1 PDF
Ejercicio 2. Dados dos sistemas de referencia {A} y {B} con diferente origen y
orientación, si se representa un punto en movimiento en un sistema de referencia
y se quiere determinar su velocidad lineal, dicha expresión se escribe de modo
general como:
Donde 𝑜˙𝐵𝐴 representa el origen del sistema de referencia (B) con respecto al
sistema de referencia {A}, 𝜔𝐵𝐴 la velocidad angular de (B) con respecto a (A), 𝑉𝑟𝐵
la velocidad del punto p en (B) y rA la posición de p expresada en (A). Indique de
modo detallado la interpretación de cada uno de los términos que componen a la
velocidad lineal 𝑉𝑟𝐴 .
Interpretación:
1. El término 𝑜˙𝐵𝐴 , indica la velocidad del origen de (B) con respecto a (A).
2. El término 𝑅𝐵𝐴 𝑉𝑟𝐵 , indica la velocidad de un punto del cuerpo en rotación
visto desde (B), pero referenciado con respecto a (A).
3. El término 𝜔𝐵𝐴 × 𝑟 𝐴 , indica la velocidad lineal inducida por el movimiento
rotacional del cuerpo en rotación.
Ejercicio 4. ¿Cuáles son los tipos de singularidades que pueden poseer un robot
manipulador y cuál es el significado de cada uno?
𝑑𝑅𝑦,0 𝑑𝑅𝑧,0
= 𝑆 (𝑗)𝑅𝑦,0 ; = 𝑆(𝑘)𝑅𝑧,0
𝑑0 𝑑0
Solución
𝑐0 0 𝑠0 −𝑠0 0 𝑐0
𝑑
𝑅𝑦,0 = ( 0 1 0 ), 𝑅 = ( 0 1 0 )
𝑑0 𝑦,0
−𝑠0 0 𝑐0 −𝑐0 0 −𝑠0
0 0 1 𝑐0 0 𝑠0 −𝑠0 0 𝑐0
𝑆 (𝑗) 𝑅𝑦,0 = (0 0 0 )( 0 1 0 )= ( 0 1 0 )
−1 0 0 −𝑠0 0 𝑐0 −𝑐0 0 −𝑠0
Figura 1.
𝑅0 0
_𝐽𝑒0 = ( 𝑒 0 ) 𝐽𝑒𝑒
𝑜 𝑅𝑒
−1 0 0 0 0 0 0 0 0
0 𝑐2 𝑠2 0 0 0 𝑠2 𝑑4 +𝐿2 0
0 𝑠2 −𝑐2 0 0 0 −𝑐2 0 1
𝐽𝑒0 = 0 0 0 −1 0 0 0 −1 0
0 0 0 0 𝑐2 𝑠2 0 0 0
0 0 0 0 𝑠2 −𝑐2 0 0 0
( )( )
0 0 0
0 𝑐2 (𝑑3 +𝐿𝑒 ) 𝑠2
1 𝑐2 (𝑑3 +𝐿𝑒 ) −𝑐2
𝐽𝑒0 = 0 1 0
0 0 0
0 0 0
( )
1. 𝐽40
2. 𝐽𝑒0
Figura 2.
𝑖 α𝑖−1 𝑎𝑖−1 𝑑𝑖 Ѳ
1 0 0 𝑑𝑖 −90
2 −90 0 𝐿2 Ѳ2
3 −90 0 𝑑3 0
4 −90 0 0 Ѳ2
e 0 𝑑𝑖 0 −90
0 1 0 0 𝑐2 −𝑠2 0 0 1 0 0 0
−1 0 0 0 −1 0 1 𝐿2 0 0 1 𝑑3
𝑇10 = ( ) , 𝑇20 = ( ) , 𝑇32 = ( )
0 1 0 𝑑1 −𝑠2 −𝑐2 0 0 0 −1 0 0
0 0 0 1 0 0 0 1 0 0 0 1
𝑐4 −𝑠4 0 0 0 1 0 𝐿𝑒
−1 0 1 0 −1 0 0 0
, 𝑇43 = ( ) , 𝑇𝑒0 = ( )
−𝑠4 −𝑐4 0 0 0 0 1 0
0 0 0 1 0 0 0 1
0 0 0 𝐿2
−𝑐2 𝑠2 1 0
𝑇20 = 𝑇10 𝑇21 = ( )
−𝑠2 −𝑐2 0 𝑑1
0 0 0 1
0 −1 0 𝐿2
−𝑐2 0 𝑠2 𝑠2 𝑑3
𝑇30 = 𝑇20 𝑇32 = ( )
−𝑠2 0 −𝑐2 𝑑1 − 𝑐2 𝑑3
0 0 0 1
0 0 −1 𝐿2
−𝑐2 𝑐4 −𝑠2 𝑠4 𝑐2 𝑠4 −𝑠2 𝑐4 0 𝑠2 𝑑3
𝑇40 = 𝑇30 𝑇43 = ( )
𝑐2 𝑐4 −𝑠2 𝑠4 𝑐2 𝑐4 −𝑠2 𝑠4 0 𝑑1 − 𝑐2 𝑑3
0 0 −1 𝐿2
𝐿2
0 𝑠2 𝑑3 )
𝑥𝑝4 =(
𝑑3 − 𝑐2 𝑑3
0 1 0 −1
𝑧10 0 0 0
= (0) , 𝑧1 = (0) , 𝑧3 = ( 𝑠2 ) , 𝑧4 = ( 0 )
1 0 −𝑐2 0
Entonces:
0 0 0 0
∂x0𝑃4 ∂x0𝑃4 ∂x0𝑃4 ∂x0𝑃4 0 𝑐2 𝑑3 𝑠2 0
1 𝑠2 𝑑3 −𝑐2 0
∂y2 ∂y2 ∂y2 ∂y2
𝐽40 = = 0 1 0 −1
0 𝑧20 0 𝑧20 0 0 0 0
( ) 0 0 0 0
( )
𝐿2
0 𝑠2 𝑑3 −𝐿𝑒 𝑐2 𝑐4 −𝐿𝑒 𝑠2 𝑠4 )
𝑥𝑝𝑒 =(
𝑑1 − 𝑐2 𝑑3 + 𝐿𝑒 𝑐2 𝑐4 −𝐿𝑒 𝑠2 𝑠4
Por lo tanto:
1. 𝐽30
2. 𝐽𝑒0
Solución
𝑖 α𝑖−1 𝑎𝑖−1 𝑑𝑖 Ѳ
1 0 0 0 Ѳ1
2 0 0 𝑑2 PI
3 −90 𝐿3 𝑑3 −90
e 0 0 𝐿𝑒 0
Figura 3
𝑐1 −𝑠1 0 0 −𝑐1 𝑠1 0 0
𝑠 𝑐 0 0 −𝑠 −𝑐1 0 0
𝑇10 = ( 1 1 ) , 𝑇20 = ( 1 )
0 1 0 0 0 0 0 𝑑2
0 0 0 1 0 0 0 1
1 𝑐1 −𝑠1 − 𝐿3 𝑐1 −𝐿𝑒 𝑠1 𝑑3
0 𝑠1 𝑐1 − 𝐿3 𝑠1 −𝐿𝑒 𝑐1 𝑑3
𝑇30 = ( )
1 0 0 𝑑2
1 0 0 1
1 𝑐1 −𝑠1 − 𝐿3 𝑐1 −𝐿𝑒 𝑐1 − 𝐿𝑒 𝑠1 𝑑3
0 𝑠1 𝑐1 − 𝐿3 𝑠1 − 𝐿𝑒 𝑐1 −𝐿𝑒 𝑐1 𝑑3
𝑇𝑒0 = ( )
1 0 0 𝑑2
1 0 0 1
De los datos anteriores se obtienen los siguientes elementos
0 0 −𝑠2
𝑧10 0 0
= (0) , 𝑧1 = (0) , 𝑧3 = ( 𝑐1 )
1 1 0
−𝐿3 𝑐1 −𝑠1 𝑑3 −𝐿3 𝑐1 −𝐿𝑒 𝑠1 − 𝑠1 𝑑3
0 0
𝑥𝑝3 = (−𝐿3 𝑐1 +𝑐1 𝑑3 ) , 𝑥𝑝𝑒 = (−𝐿3 𝑠1 +𝐿𝑒 𝑐1 + 𝑐1 𝑑3 )
𝑑2 𝑑2
𝐿3 𝑠1 − 𝑐1 𝑑3 0 −𝑠1
∂x0𝑃3 ∂x0𝑃3 ∂x0𝑃3 −𝐿3 𝑐1 − 𝑠1 𝑑3 0 𝑐1
𝐽30 = ( ∂q1 ∂q2 ∂q3 )= 0 1 0
0 0 0
𝑧10 0 0 0 0 0
( 1 0 0 )
𝐿3 𝑠1 +𝐿𝑒 𝑐1 + 𝑐1 𝑑3 0 −𝑠1
∂x0𝑃𝑒 ∂x0𝑃𝑒 ∂x0𝑃𝑒 −𝐿3 𝑐1 +𝐿𝑒 𝑠1 + 𝑠1 𝑑3 0 𝑐1
𝑒 = ( ∂q1 ∂q2 ∂q3 )= 0 1 0
0 0 0
𝑧10 0 0 0 0 0
( 1 0 0 )
1. 𝐽40
2. 𝐽𝑒0
Solución
Figura 4.
𝑖 α𝑖−1 𝑎𝑖−1 𝑑𝑖 Ѳ
1 0 0 𝐿1 Ѳ1
2 0 𝐿2 𝐿2𝑎 Ѳ2
3 90 0 0 Ѳ3
4 90 0 𝑑4 0
e 0 𝑑𝑖 𝐿𝑒 0
Consideramos las variables articulares q = (q1, q2, q3, q4)^T = (θ1, θ2, θ3, d4)^T,
los Jacobianos del manipulador son:
=
−𝐿2 𝑠1 − 𝑠12 𝑠3 𝑑4 + 𝐿𝑒 𝑠12 𝑠3 − 𝑠12 𝑠3 𝑑4 + 𝐿𝑒 𝑠12 𝑠3 𝑐12 𝑐3 𝑑4 − 𝐿𝑒 𝑐12 𝑐3 𝑐12 𝑠3
−𝐿2 𝑠1 − 𝑐12 𝑠3 𝑑4 + 𝐿𝑒 𝑐12 𝑠3 − 𝑐12 𝑠3 𝑑4 − 𝐿𝑒 𝑐12 𝑠3 𝑠12 𝑐3 𝑑4 − 𝐿𝑒 𝑠12 𝑐3 𝑠12 𝑠3
0 0 𝑠3 𝑑4 − 𝐿𝑒 𝑠3 − 𝑐3
0 0 𝑠12 0
0 0 −𝑐12 0
( 1 1 0 0 )
Solución
0 0 𝑐1 −𝑠1
3 0 0
𝑃𝑛𝑒 = ( ) , 𝑅3 = ( 0 𝑠1 𝑐1 )
𝐿𝑒 1 0 0
0 𝑐1 −𝑠1 0 −𝐿𝑒 𝑠1
0
𝑃𝑛𝑒 = 𝑅30 𝑃𝑛𝑒
3
= ( 0 𝑠1 𝑐1 ) ( 0 ) = ( 𝐿𝑒 𝑐1 )
1 0 0 𝐿𝑒 0
0 𝑐1 𝐿𝑒 𝑐1
0 0 𝑠1 𝐿𝑒 𝑠1 )
𝑃𝑛𝑒 =(
−𝐿𝑒 𝑐1 −𝐿𝑒 𝑠1 0
𝐿𝑒 𝑠1 −𝐿𝑒 𝑐1 − 𝑐1 𝑑3 0 − 𝑠1
−𝐿𝑒 𝑐1 −𝐿𝑒 𝑠1 − 𝑠1 𝑑3 0 𝑐1
= 0 1 0
0 1 0
0 1 0
( 0 1 0 )
Solución
0 − 𝐿𝑒 𝑐3 − 𝐿𝑒 𝑠12 𝑠3
0 0 𝑠1 𝐿𝑒 𝑐12 𝑠3 )
𝑃𝑛𝑒 =(
𝐿𝑒 𝑠12 𝑠3 −𝐿𝑒 𝑐12 𝑠3 0