art2junio08

Embed Size (px)

Citation preview

  • 7/22/2019 art2junio08

    1/7

    RIEE&C, REVISTA DE INGENIERA ELCTRICA, ELECTRNICA Y COMPUTACIN, Vol. 4 No. 1, JULIO 2008

    ISSN 1870 - 9532

    9

    Fig. 1 Similitud brazo robtico con extremidades superiores del

    cuerpo humano

    Diseo propio y Construccin de un BrazoRobtico de 5 GDL

    Martnez A. Gloria M., Jquez O. Sonia A., Rivera M. Jos y Sandoval R. Rafael.

    Resumen.- Los robots de diseo propio son los que sedesarrollan con materiales reciclados y son diseos propios dequienes los programa, tiene un bajo costo econmico, tanto enadquisicin, como en mantenimiento e instalacin,

    normalmente estn diseados para cumplir un solo tipo deaplicaciones; por lo que su arquitectura puede ser cerrada, sonveloces para cumplir sus tareas, que normalmente estndefinidas, su exactitud es muy variable (80-100%), debido a la

    diversidad de los materiales con que son construidos, suambiente de programacin est limitado a ciertos movimientosy adquisicin de datos de sus sensores. Estas ventajas los haceun gran apoyo para desarrollar investigacin en sistemas de

    control de robots manipuladores. Este artculo presenta lametodologa del diseo propio, construccin y especificaciones

    bsicas de un robot manipulador, usando como herramienta dediseo el software SolidWorks por su amplia gama decomandos de diseo y anlisis dentro de las tecnologas CAD.Con esta metodologa se demuestra que el diseo de un robot

    puede ser de bajo costo y de alto rendimiento obteniendo undiseo y un ensamble del mismo antes de la construccin, a lacual se parte despus de tener un resultado satisfactorio deldiseo. El robot manipulador usado para demostrar esta

    metodologa cuenta con 5 grados de libertad los cuales sonsuficientes para un amplio campo de accin en cuanto a susmovimientos; se muestran tambin las bases tericas de sumodelado cinemtico para terminar de cumplir con un diseo

    verstil, prctico, y con especificaciones bien fundamentadas.

    Palabras claveRobtica, diseo propio, construccin,caracterizacin.

    I. INTRODUCCINUn brazo manipulador o brazo robtico se puede definir

    como el conjunto de elementos electromecnicos quepropician el movimiento de un elemento terminal (gripper oherramienta) [1,2].

    La constitucin fsica de la mayor parte de estosmanipuladores guarda cierta similitud con la anatoma de lasextremidades superiores del cuerpo humano, por lo que, enocasiones, para hacer referencia a los distintos elementos que

    componen al robot, se usan trminos como: cintura, hombro,

    brazo, codo, mueca, etc. Como se muestra en la Figura 1.Una especificacin general de un brazo robtico

    comprende: sus grados de libertad, su configuracin y sucinemtica directa e inversa [7,9]. Estas especificaciones sondadas desde el diseo propio de cada robot y su aplicacin.Hay una clasificacin de robots manipuladores la cual

    presenta las diferencias de diseo, precisin, precio, etc.,esta se puede apreciar en la Tabla I.Tomando en cuenta que la mayora del equipo robtico

    dentro de un rea acadmica y de investigacin son de tipoindustrial o comercial [3,6,8,9,10], los cuales ya estnespecificados y caracterizados, adems en la literaturarevisada son pocos los modelos de robots de diseo propio[12,13,14] en los cuales se basan ms a su control que a sumodelado, en este artculo se presenta una metodologa dediseo propio y construccin de un brazo manipulador de 5grados de libertad (GDL) basado en la tecnologa CAD, al

    Manuscrito recibido el 7 de Diciembre de 2007. Este trabajo fue respaldadopor la Divisin de Estudios de Posgrado e Investigacin del InstitutoTecnolgico de Chihuahua.

    G. Mnica Martnez A. y Sonia A. Jquez hasta la fecha se han dedesempeado como estudiantes del programa de M. C. en Ing. Electrnica delInstituto Tecnolgico de Chihuahua en la Divisin de Estudios de Posgrado eInvestigacin (DEPI-ITCH); Ave. Tecnolgico 2909; Chihuahua, Chih.,Mxico; C.P. 31310; Tel: (614) 201-2078, ext. 36; ([email protected] [email protected])

    Jos Rivera M. y Rafael Sandoval R. hasta la fecha se han dedesempeado como Profesores Investigadores de la DEPI-ITCH (e-mail

    [email protected] [email protected])

    TABLA I. CLASIFICACIN DE ROBOTS MANIPULADOR

    Tipo deRobot

    Tipocomercial

    de uso

    general

    Tipo dediseopropio

    Tipo y usoindustrial

    Accesoeconmico

    Accesiblecosto

    Bajo costo Alto costo

    Costo deinstalacin y

    mantenimiento

    Bajocosto

    Bajo costo Alto costo

    Arquitecturaabierta

    Si No No

    Velocidad Lento Rpido Muy rpidoAmbiente de

    programacinRobusto Si No No

    Exactitud0-100%

    70-100% 80-100% 90-100%

    EjemplosLego

    Mecano

    Desarrolladoscon material

    reciclado

    PumaScara

  • 7/22/2019 art2junio08

    2/7

    RIEE&C, REVISTA DE INGENIERA ELCTRICA, ELECTRNICA Y COMPUTACIN, Vol. 4 No. 1, JULIO 2008

    ISSN 1870 - 9532

    10

    a) b)

    c)Fig. 2 Servomotores utilizados: a) HS-805BB, b) HS-311 y c)

    FP-S148.

    a) b)

    c) d)

    e) f)

    Fig. 3 Ensamble y piezas utilizadas hasta Hombro a) caja decontrol y soporte base, b)tapa caja, c) anillo de distribucin de peso

    de base, d) ensamble de base con caja soporte vista superior, e)

    ensamble de base con caja soporte vista inferior, f) soporte motor

    hombro, g) perfil de soporte, h) ensamble hasta hombro.

    g)

    h)

    cual se decidi nombrar SPIDER, mostrando las ventajasdentro de lo econmico y lo prctico de tener tecnologa

    propia, mostrando tambin que su modelado cinemtico ysus principales especificaciones se pueden obtener demanera sencilla y estn fundamentadas de manera confiabletanto como tecnologas comerciales e industriales,incluyendo como resultados del trabajo de este artculo lasimulacin de trayectorias utilizando la cinemtica obtenidade SPIDER.

    En la Seccin II se presenta el diseo del brazomanipulador, en la Seccin III se aborda la construccinfsica del robot, la especificacin general en la que se incluyela cinemtica directa e inversa y simulacin de trayectorias,en la Seccin IV se presentan conclusiones del trabajo

    presentado y por ltimo se listan las referencias consultadas.

    II. DISEO DEL ROBOTEl brazo robtico SPIDER est compuesto de segmentos

    o miembros interconectados por puntas o articulaciones,cada articulacin est compuesta sobre un eje del cual girandos segmentos, cuyos movimientos son generados porservomotores. Los distintos elementos del brazo son: la base(A), el hombro (B), el brazo (C), codo (D), mueca (E) y

    pinza (F).Se utiliz SolidWorks [11] como herramienta de diseo

    del brazo robtico, as mismo se aprovecharon las ventajasde simulacin con las que cuenta este software para evaluarsu posible desempeo.

    El robot est basado en una configuracin de un robotarticulado [5] de 5 GDL, cada pieza fue diseada enSolidWorks

    y al finalizar el modelado de las piezas, serealiz un ensamble virtual para hacer las correcciones ymodificaciones que fueran necesarias hasta que arrojaran unresultado satisfactorio.

    A. Dimensiones y ensamble.

    De forma breve y sencilla se muestra el ensamble y elmodelo de las piezas del robot as como de los motores

    utilizados, los servomotores utilizados fueron de 3 tipossiendo el ms grande el Hitec HS-805BB (utilizado en

    base, hombro y codo), seguido del HitecHS-311 (utilizadoen la mueca y el roll) y por ltimo un Futaba FP-S148(para la pinza) que se muestran en la Figura 2.

    Se empieza el ensamble de abajo hacia arriba de loselementos del brazo el cual se puede apreciar de la Figura 3 ala 8.

    Una vez que se complet el ensamble de manerasatisfactoria utilizando SolidWorks se realizaron variassimulaciones como un anlisis de colisiones entre piezas conel cual se defini la envolvente de trabajo de SPIDER,adems se realiz un anlisis de propiedades fsicas de cada

    pieza (densidad, masa, rea de superficie, momentos deinercia, etc.), esto con el fin de tener una clara idea delfuncionamiento del diseo al ser construido y as evitar

    prdidas de material y tiempo.

  • 7/22/2019 art2junio08

    3/7

    RIEE&C, REVISTA DE INGENIERA ELCTRICA, ELECTRNICA Y COMPUTACIN, Vol. 4 No. 1, JULIO 2008

    ISSN 1870 - 9532

    11

    Fig. 6 Ensamble mueca.

    III.CONSTRUCCIN FSICA DEL ROBOT

    A. Construccin del robot diseado.

    Despus del diseo se procedi a la construccin, elmaterial utilizado fue aluminio, por su ligereza y fcilmanejo, nos apoyamos de un taller de soldadura con extensamaquinaria (plasmas, fresadoras CNC, tornos, taladros,

    a ) b) c)

    d)

    Fig. 4 Ensamble y piezas utilizadas hasta el brazo a) ensamble hasta

    brazo, b) brazo con buje, c) brazo con motor y d) tapa de brazo.

    a) b) c)

    d) e)

    Fig. 5 Ensamble y piezas utilizadas hasta el codo a) ensamble hombro y

    codo, b) codo con motor, c) codo sin motor, d) buje y e) tapa de codo.

    a) b) c)

    Fig. 7 Piezas utilizadas para la mueca a) soporte motores mueca y de

    pinza, b) tapa mueca y c) flecha pinza.

    Fig. 8 Ensamble pinza y piezas utilizadas para pinza a) Ensamble pinza

    vista superior, b) ensamble pinza vista inferior, c)perno separador pinzar,

    d)base pinza, e) dedo pinza y f) acople motor pinza.

    a) b) c)

    d) e) f)

    a) b)Fig. 9 Comparacin entre diseo y construccin de SPIDER a) diseo

    ensamble virtual vista frontal y b) construccin ensamble real vista frontal.

  • 7/22/2019 art2junio08

    4/7

    RIEE&C, REVISTA DE INGENIERA ELCTRICA, ELECTRNICA Y COMPUTACIN, Vol. 4 No. 1, JULIO 2008

    ISSN 1870 - 9532

    12

    dobladoras, mquinas de soldar, etc.) para poder llevar acabo la fabricacin acorde al diseo de las piezas, en laFigura 9 se puede comparar el ensamble virtual del diseocon el resultado obtenido de la construccin.

    B. Caractersticas Tcnicas.

    Terminado el diseo y la construccin se realiz unanlisis de sus principales caractersticas para determinar su

    peso, el cual es de 4kg, amplitud, velocidad y resolucin, losresultados se muestran en la Tabla II. La envolvente detrabajo se muestra en la Figura 10.

    C. Cinemtica Directa

    Despus de tener establecido un modelo y susespecificaciones se puede proceder a obtener su cinemticapara completar con esta su modelado.

    Para el clculo de la matriz de transformacin de lacinemtica directa del robot se asignaron los siguientes ejesa cada articulacin; los cuales se asignaron siguiendo elalgoritmo D-H [7, 9]. Como se puede apreciar en la Figura11.Considerando las medidas de las articulaciones que se

    pueden ver en la Figura 12 y la asignacin de ejes se

    Fig. 10 Dimensiones envolvente de trabajo SPIDER a) envolvente trabajo

    vista superior, b) apertura mxima pinza y c) envolvente trabajo vista

    lateral.

    c)

    a)

    b)

    TABLA II.CARACTERSTICAS BSICAS DEL ROBOT

    Articulacin A B D E F

    Amplitud () 180 180 180 180 90

    Rango deTrabajo ()

    90 90 90 +80/-100

    45

    VelocidadNominal (/s)

    428.57

    428.57

    428.57

    400 400

    ResolucinAngular ()

    1 1 1 1 1

    Fig. 11 Asignacin de Ejes.

    Fig. 12 Medidas entre articulaciones. (Medidas en centmetros).

  • 7/22/2019 art2junio08

    5/7

    RIEE&C, REVISTA DE INGENIERA ELCTRICA, ELECTRNICA Y COMPUTACIN, Vol. 4 No. 1, JULIO 2008

    ISSN 1870 - 9532

    13

    procedi a llenar la tabla de parmetros del robot (Tabla III)para el clculo de la cinemtica directa.

    Usando estos parmetros se puede obtener la ecuacindel brazo (modelo cinemtico directo) la cual mapea elsistema coordenado L5 de la punta de la herramienta, conrespecto al sistema coordenado L0de la base, esta ecuacinresulta,

    50 1 2 3 4 5( , , , , ) 0 0 0 1

    N D A PT

    =

    (1)

    DondeNes el vector normal,

    1 234 5 1 5

    1 234 5 1 5

    234 5

    CC C S S

    N SC C CS

    S C

    + =

    (2)

    D es el vector de deslizamiento,

    1 234 5 1 5

    1 234 5 1 5

    234 5

    CC S SC

    D SC S CC

    S S

    + =

    (3)

    A es el vector de aproximacin,

    1 234

    1 234

    234

    CS

    A S S

    C

    =

    (4)

    y P es el vector de posicin,

    ( )

    ( )

    1 234 234 23 2

    1 234 234 23 2

    234 234 23 2

    130 25 36 54

    81

    30 25 36 54825 15 25 9 27

    8 4 8 2 4

    C S C C C

    P S S C C C

    C S S S

    + + +

    = + + + + + +

    (5)

    D. Cinemtica Inversa.

    Para la cinemtica inversa del robot se tom en cuentaslo la solucin codo arriba en las Figuras 13 y 14 se puedenapreciar los clculos realizados para esta configuracin.

    Las ecuaciones obtenidas mediante trigonometra (comose puede apreciar toda la nomenclatura est referenciada enlas Figuras 13 y 14), resultan,

    2 2Pxy Px Py= + (6)

    11 tan

    Py

    Px

    =

    (7)

    4 5( )cosf Pxy d d = + (8)

    4 5 1( )e Pz d d sen d = + (9)

    tan2e

    af

    =

    (10)

    2 2c e f= + (11)

    2 2 21 3 2

    2

    cos2

    a a c

    a c

    =

    (12)

    2 2 21 3 2

    2 3

    cos2

    c a a

    a a

    =

    (13)

    2 = + (14)

    3 = (15)

    TABLA III.PARMETROS D-H DEL ROBOT

    Articulacin d a a

    1 1 7.53 90 0

    2 2 0 0 16.83

    3 3 0 0 11.43

    4 4 8.20 90 0

    5 5 9.20 0 0

    Fig. 14 Diagrama lateral solucin Codo Arriba.

    Fig. 13 Diagrama superior solucin Codo Arriba.

  • 7/22/2019 art2junio08

    6/7

    RIEE&C, REVISTA DE INGENIERA ELCTRICA, ELECTRNICA Y COMPUTACIN, Vol. 4 No. 1, JULIO 2008

    ISSN 1870 - 9532

    14

    4 2 32

    = + (16)

    Estas son las ecuaciones para calcular los ngulos en cadaarticulacin dado una posicin (x,y,z) del elemento terminaldel robot.

    E. Simulacin de Trayectorias.

    Con las siguientes coordenadas (x,y,z) que se aprecianen la Figura 15, donde los puntos son las coordenadas (x,y) ylas lneas la trayectoria esperada, donde la coordenada z sefij a un valor constante de 5.Se simul la trayectoria con la cinemtica inversa del robot

    en MATLAB.El programa se realiz con perfiles de velocidad

    uniforme y trapezoidal, primero se procedi a trazar laslneas, despus por separado los diferentes niveles detelaraa. Por lo que se realizaron 7 diferentes trayectorias: 4de las lneas y 3 por cada nivel de telaraa.

    Para las primeras 4 trayectorias se calcul con unavelocidad de 3 cm/sg y los tiempos de aceleracin/desaceleracin de 1 sg. Para los niveles de telaraa se usouna velocidad de 1 cm/sg y los tiempos deaceleracin/desaceleracin de 0.5 sg.

    El resultado obtenido en la programacin de lastrayectorias propuestas se puede apreciar en la Figura 16, dela cual se pude concluir que el cinemtico obtenido deSPIDER es correcto.

    IV. CONCLUSIONESEl diseo de este robot fue sencillo y prctico con la

    herramienta de Solidworks la cual nos ayudo a tener unmodelo esperado sin prdida de tiempo y material, haciendoa SPIDER econmico y con un campo de accin de mltipleaplicacin debido a sus 5 GDL, por lo que queda asentadoque un robot de diseo propio est al alcance de cualquiera,

    por su fcil diseo y construccin, siguiendo la metodologapropuesta. En este proyecto se cont con la ayuda de untaller especializado, sin embargo consideramos que an sinun taller de este tipo se puede llevar a cabo la construccinde un robot de diseo propio de una manera sencilla yeconmica. Tambin se puede obtener sus especificacionesaplicando las bases tericas que implementamos en esteartculo las cuales son de uso general dentro del rea derobtica.

    El mtodo utilizado de diseo, simulacin y construccines una ventaja en cuanto a no tener prdidas de material ytiempo lo cual es econmico y prctico, y adems cumplecon el cometido de las tecnologas CAD.

    Un trabajo a futuro consiste en la caracterizacin de estebrazo manipulador, la cual consta de un anlisis detalladosobre parmetros tales como la confiabilidad, laincertidumbre (condiciones de trabajo), la precisin, laexactitud, caractersticas de carga y MTBF.

    REFERENCIAS[1] Mendonza Snchez Eduardo Augusto, Control de un Robot

    Manipulador, Tesis Profesional, Marzo 2004, Universidad de lasAmricas, Puebla. Disponible en:http://catarina.udlap.mx/u_dl_a/tales/documentos/lep/mendoza_s_ea/capitulo2.pdf[2] Gonzlez Victor R, Centro de Formacin del Profesorado e InnovacinEducativa Valladolid II, Curso 2007: Fundamentos de Robtica,Valladolid, Espaa. Disponible en:http://cfievalladolid2.net/tecno/ctrl_rob/robotica/sistema/morfologia.htm.[3] Parra Marquez Juan Carlos, Cid Cifuentes Karina Pilar;Implementacin de Robot Scorbot er-vplus, para docencia, en realidad

    virtual, Revista Digital Universitaria UNAM, Mayo 2007, Volumen 8Nmero 5, ISSN: 1067-6079.[4] Apuntes de Control Numrico, Unidad Profesional Interdisciplinaria deIngeniera y Ciencias Sociales y Administrativas.Disponible en: http://www.geocities.com/siei2006/BRAZOROBOTICO.pdf[5] Williams Karl, Build your own Humanoid Robots, Mc Graw-Hill2004, ISBN 0-07-142274-9.[6] Juarez C. Jesse I, Ramrez H. Lucia Guadalupe, Rivera M. Jos,

    Maldonado O. Cristina, Sandoval R. Rafael, Instrumento Virtual para elcontrol del Robot Industrial Motoma UP- 20, Somi XXI Congreso deInstrumentacin, Octubre 2006. ISBN 970-32-2673-6.[7] Sandoval R. Rafael, Apuntes de Fundamentos de Robtica, Curso2007. Instituto Tecnolgico de Chihuahua.[8] Tzvi Raz, Graphics robot Simulator for Teaching Introductory robotics,IEEE Transactions on Education, Vol 32 No. 2, Mayo 1989.[9] R. J. Schilling, Fundamentals of Robotics: Analisys and Control.Englewood Cliffs, N.J., Prentice-Hall 1990.[10] White, R.B. Read, R.K. Koch, M.W. Schilling, R.J., A GraphicsSimulator for Robotic Arm, IEEE Transactions on Education, Vol. 32 No. 4,

    Noviembre 1989.[11] L. Stephen Wolfe, Roy Wysack, Design parts with SolidWorks, 2edition Junio 1997, ISBN-100934869227.

    Fig. 16 Resultado de la Simulacin de trayectorias realizada en MATLAB.

    Fig. 15 Coordenadas de la trayectoria (los puntos son las coordenadas y

    las lneas la trayectoria esperada).

  • 7/22/2019 art2junio08

    7/7

    RIEE&C, REVISTA DE INGENIERA ELCTRICA, ELECTRNICA Y COMPUTACIN, Vol. 4 No. 1, JULIO 2008

    ISSN 1870 - 9532

    15

    [12] Ramn Pernia Grillo, Diseo y Construccin del prototipo mecnico deun robot de limpieza domstico, proyecto del Departamento de Informticae Ingeniera Industrial, Especialidad Mecnica, Universidad de Lleida.[13]Eduard Ros Ramn, Diseo y construccin de la estructura mecnicade un hexpodo, proyecto de la Escola Politcnica Superior, C/ Jaume II 69,25001 Lleida.[14] F. Dreoni, M.G. Ortega, F.R. Rubio, J. Gmez-Ortega, Identificacin yControl de un Robot Manipulador, Proyecto de investigacin CICYTDPI2001-2424-C02 y DPI2000- 1218-C0401.

    Gloria Mnica Martnez Aguilar naci un

    18 de Diciembre de 1981 en Torren, Coahuila.Obteniendo el Grado de Ingeniero Electrnico conespecialidad en Instrumentacin y Control en elInstituto Tecnolgico de la Laguna en el ao del2005. Actualmente estudia la Maestra en Cienciasen Ingeniera en Electrnica en la especialidad deInstrumentacin en el Instituto Tecnolgico deChihuahua. Ha realizado investigaciones en el reade Robtica e Instrumentacin. Es miembro delClub de Robtica del Instituto Tecnolgico de

    Chihuahua.Sonia Anabel Jquez Olveranaci un 24 de

    Octubre de 1978 en Ciudad Cuauhtemoc Chihuahua.Obteniendo el Grado de Ingeniero Industrial enCalidad y Productividad por el Instituto Tecnolgicode Cd. Cuauhtemoc en el ao del 2001.Actualmente estudia la Maestra en Ciencias enIngeniera en Electrnica en la especialidad deInstrumentacin en el Instituto Tecnolgico de

    Chihuahua. Ha realizado investigaciones en el rea de Robtica Mvil. Esmiembro del Club de Robtica del Instituto Tecnolgico de Chihuahua.

    Meja R. Jos en 1987 obtuvo el ttulo de Ingenieroen Electrnica con especialidad en instrumentacinen el Instituto Tecnolgico de Cd. Guzmn Jal.Obtuvo el grado Maestro en Ciencias en 1983 enIngeniera Electrnica en el Instituto Tecnolgico deChihuahua. De 1985 a 1995 labor en la empresaCable Productos de Chihuahua y desde 1995 a lafecha es profesor investigador en la divisin de

    estudios de Posgrado e Investigacin del InstitutoTecnolgico de Chihuahua. Ha publicado

    internacionalmente varios artculos cientficos y tcnicos. Sus reas deinvestigacin son: Instrumentacin y control, Metrologa, Estudios deconfiabilidad, procesamiento digital de seales, y desarrollo de aplicacionescon lgica difusa y redes neuronales.

    Rafael Sandoval Rodrguez naci un 24 deOctubre de 1968, recibi los grados de IngenieroIndustrial en Electrnica y de Maestro en Cienciasen Ingeniera en Electrnica, por el InstitutoTecnolgico de Chihuahua, en 1991 y 1994,respectivamente. Recibi el grado de Doctor enFilosofa en Ingeniera Elctrica, por la Universidadde Nuevo Mxico, en el 2005. Es miembro de laIEEE y asesor de la rama estudiantil IEEE en elITCH. Es miembro del Sistema Nacional deInvestigadores del CONACYT. Actualmente es

    Profesor Investigador en el ITCH. Sus areas de investigacin son robtica,redes de sensores y sistemas de control en redes.