Geometría y Cnemáta Control y Programaón de Robot
Cnemáta de un Robot Manpulador Cnemáta dreta Cnemáta Invera Matrz Jaobana
Cnemáta de un Robot Manpulador Cnemáta del robot : Etudo de u movmento on repeto a un tema de referena Derpón analíta del movmento epaal en funón del tempo Relaone: loalzaón del extremo del robot-valore artulare Problema nemáto dreto: Determnar la poón y orentaón del extremo fnal del robot, on repeto a un tema de oordenada de referena, onodo lo ángulo de la artulaone y lo parámetro geométro de lo elemento del robot Problema nemáto nvero: Determnar la onfguraón que debe adoptar el robot para una poón y orentaón del extremo onoda Modelo dferenal (matrz Jaobana): Relaone entre la velodade de movmento de la artulaone y la del extremo del robot 3
Cnemáta de un Robot Manpulador 4
Cnemáta de un Robot Manpulador Reoluón del problema nemáto dreto on matre de tranformaón homogénea 5
Modelo dreto q n q q n- p(x,y,z,,β,γ) q Cálulo de la poón y orentaón de ualquer punto del robot (Elemento Termnal) en funón la varable artulare Proedmento temáto de Denavt-Hartemberg 6
Proedmento de oloaón de Eje de Referena. Identfar lo Enlae y Eje de la artulaone y trazar línea magnara a lo largo de ello. + + 7
Proedmento de oloaón de Eje de Referena. Identfar la perpendular omún entre eje oneutvo. El orgen del SR etará en la ntereón del Eje on la normal omún entre lo eje e + + + 8
Proedmento de oloaón de Eje de Referena 3. Coloar el eje Z obre el eje de la artulaón Z Z + + 9
Proedmento de oloaón de Eje de Referena 4. Coloar el eje X obre la perpendular omún, o lo eje nteretan, obre la normal al plano que forman lo eje Z y Z + Z Z X + + X
Proedmento de oloaón de Eje de Referena 5. Coloar el eje Y ompletando un tema de referena dextrógro Z Z Y Y X + + X
Parámetro D-H Parámetro de Denavt-Hartemberg (D-H) Cuatro Parámetro: Do ángulo (, - ) Do dtana (d, a - )
Parámetro D-H Defnen el pao de un tema de referena aoado a una artulaón al guente Sólo dependen de la arateríta geométra de ada elabón y de la artulaone que le unen on el anteror y guente (no dependen de la poón del robot) Defnen la matre A que permten el pao de un tema de referena aoado a una artulaón al guente y por tanto defnen la matre T Cuatro Parámetro: Do ángulo (, - ) Do dtana (d, a - ) 3
Interpretaón Parámetro D-H : E el ángulo de x - ax medda obre z (utlzando la regla de la mano dereha). d : E la dtana de x - ax medda a lo largo de z a : E la dtana de z a z + medda a lo largo de x : E el ángulo de z a z + medda obre x (utlzando la regla de la mano dereha). 4
) (,, ), (,,) ( ), ( d d a d a A d T z T a T x T A Matre de tranformaón Matre de tranformaón 5
) (,, ), (,,) ( ), ( d d a d a A d T z T a T x T A Matre de tranformaón Matre de tranformaón 6
) (,, ), (,,) ( ), ( d d a d a A d T z T a T x T A Matre de tranformaón Matre de tranformaón 7
) (,, ), (,,) ( ), ( d d a d a A d T z T a T x T A Matre de tranformaón Matre de tranformaón 8
) (,, ), (,,) ( ), ( d d a d a A d T z T a T x T A Matre de tranformaón Matre de tranformaón 9
Cnemáta de un Robot Planar GDL Ejemplo: Z Z Y Y Z X 3 Y Z 3 3 - -9º a - a a d Y 3 d 3 X X X a a
Cnemáta de un Robot Manpulador Ejemplo: Robot Indutral RM-
Cnemáta de un Robot Manpulador
Cnemáta de un Robot Manpulador 3
Cnemáta de un Robot Manpulador Matrz de Cambo para problema nemáto dreto 4
Cnemáta de un Robot Manpulador Matrz de Cambo para problema nemáto dreto 5
Cnemáta Invera 6
Cnemáta Invera: Poble Soluone 7
Cnemáta Invera: Método 8
Cnemáta Invera: Método Geométro Ejemplo de oluón del problema nemáto Invero por método geométro 9
Cnemáta Invera: Método Geométro Ejemplo de oluón del problema nemáto Invero por método geométro (Múltple oluone) 3
Cnemáta Invera: Método Matre Homogénea Ejemplo de oluón del problema nemáto Invero medante matre de tranformaón homogénea - a - d z 3 Y 3-9º l q q x 3 3 q 3 z z Y x z q x q A Y q q l q A q q q Y x A3 q 3 3
Cnemáta Invera: Método Matre Homogénea 3 Ejemplo de oluón del problema Ejemplo de oluón del problema nemáto nemáto Invero medante Invero medante matre de tranformaón homogénea matre de tranformaón homogénea l Cq Sq Sq Cq 3 3 q q q q q q q q q q 3 ) ( artan ) artan( y x x z y x x y y x p p Sq p Cq q p l p p q p p q p Sq p Cq + + +
Cnemáta Invera: Método de reduón polnóma Conte en tranformar la euaone traendentale obtenda por método algebrao o geométro para que adopten forma polnóma,, má fále en prnpo de reolver. Alguna tranformaone uuale u tan u o + u u n + u a o + bn oluton) a( u ( a + ) u b ± u tan ) + bu ( + u bu + ( a) b a a + b ± b a a + ) 33
Cnemáta Invera: Deaoplamento nemáto E típo en robot de 6 GDL Se puede reolver de forma explíta lo 3GDL que defnen la orentaón de la garra. 34
Cnemáta Invera: Deaoplamento nemáto E típo en robot de 6 GDL Eje 4,5,6 e nteretan en un punto Exte oluón analíta por método algebrao (Método de Peper). 35
Cnemáta Invera: Conderaone omputaonale Para egumento de trayetora e neearo reolver el problema nemáto a gran velodad (3 vee/eg eg o má). Son preferble la oluone errada explíta ( exten) ) a la teratva. Para aelerar álulo generalmente e emplean tabla prevamente alulada (look( look-up table) El ote de alular n oluone, no e neearamente n vee el de alular una úna oluón. 36
Epefaone del uuaro y loalzaone etándar {B} {W} {S} {T} {G} {S} Maro de referena de la elda de trabajo {B} Maro de referena bae del robot {T} Maro de referena de la herramenta {G} Maro de referena objetvo (Objeto a manpular) {W} Maro de referena del extremo termnal del robot (Sn herramenta) Objetvo: Planear euena de movmento artulare para llevar {T} a {G} atfaendo la retrone del problema 37
Velodade Lneale y Rotaonale Tranformaón de velodade lneale A V P A V p A B A + R V ORG B P+ ΩB A B R B P B Ω C {B} {C} Tranformaón de velodade angulare Z A {A} A P Z B B P A Ω B A Ω C A Ω B + A B B R Ω C A P ORG Y B x B x A Y A 38
Matrz Jaobana 39
Matrz Jaobana Relaone Dferenale 4
Matrz Jaobana En Robóta la matrz Jaobana derbe la relaone entre la velodade artulare (( ) y la velodade lneale y de rotaón del efetor fnal (x ) 4
Matrz Jaobana en el domno de la fuerza Adonalmente etamo ntereado en onoer la relaón entre lo pare artulare que e ejeren obre el robot (τ( ) y la fuerza/momento ejerda por el efetor fnal (F( ) Prnpo de lo trabajo vrtuale T F T δx τ δ 4
Matrz Jaobana en el domno de la fuerza Defnón de Jaobano δx Jδ δ T F T Jδ τ δ τ J T F La Expreón anteror e puede expandr omo 43
Matrz Jaobana Ejemplo: Jaobana de un robot Plano de 3GDL Calular la relaone que derben la guente gualdade 44
Matrz Jaobana Ejemplo: Jaobana de un robot Plano de 3GDL Parametro del efetor fnal Cnemáta Dreta 45
Matrz Jaobana Ejemplo: Jaobana de un robot Plano de 3GDL d dt 46
Matrz Jaobana En forma matral tenemo 47
Matrz Jaobana Jaobana de un robot SCARA 48
Matrz Jaobana Invera 49
Matrz Jaobana Invera: Confguraone Sngulare 5