seminario “diseño y construcción de microrrobots” · • se utiliza un puente en h que se...

50
Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 1 SEMINARIO: Dise SEMINARIO: Dise ñ ñ o y Construcci o y Construcci ó ó n de Microrrobots n de Microrrobots CONTROL DE MOTORES SEMINARIO “Diseño y construcción de Microrrobots” D. Jesús Ureña Ureña [email protected]

Upload: lamdien

Post on 24-Apr-2018

213 views

Category:

Documents


0 download

TRANSCRIPT

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 1

SEMINARIO: DiseSEMINARIO: Diseñño y Construccio y Construccióón de Microrrobotsn de Microrrobots

CONTROL DE MOTORES

SEMINARIO“Diseño y construcción de

Microrrobots”

D. Jesús Ureña Ureñ[email protected]

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 2

GUIGUIÓÓNN

•MOTORES ... ¿PARA QUÉ?•Tracción y dirección en Micro-Robots

•Orientación de sistemas sensoriales

•MOTORES DC• Tipos y funcionamiento• Características y dimensionado de un motor DC• Reductoras y encoders• Selección de un motor para Micro-Robots• Control en lazo abierto

• Driver lineales• Puente en H

• Control en lazo cerrado

•Servomotores

•MOTORES P-P•Tipos y funcionamiento• Características y dimensionado de un motor DC• Control de motores paso a paso

•Alimentación: baterías

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 3

1. MOTORES ... 1. MOTORES ... ¿¿PARA QUPARA QUÉÉ??

Los motores permiten la conversión de energía eléctrica en mecánica, permitiendo el movimiento del robot.

Los movimientos pueden ser de rotación más o menos continua (caso de ruedas tractoras).

O de pequeños desplazamientos (caso de patas, dirección por volante, orientación de sensores, etc.)

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 4

¿¿CCÓÓMO SEMO SE DESPLAZA UN ROBOT?DESPLAZA UN ROBOT?

DIRECCIÓN DIFERENCIAL:Dos ruedas de tracción independientes

ARQUITECTURA TRICICLO:Tracción y dirección independientes

TIPO COCHETracción y dirección en dos ruedas

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 5

¿¿CCÓÓMO SEMO SE DESPLAZA UN ROBOT?DESPLAZA UN ROBOT?

MOVIMIENTO CON PATAS:Cada pata requiere dos rotaciones

DIRECCIÓN SÍNCRONA:Rotación simultánea de todas las ruedas

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 6

CINEMCINEMÁÁTICATICA DE UN ROBOTDE UN ROBOT

CINEMÁTICA DIRECTA:

¿Cómo afectan los movimientos de los ejes de un robot a su posición y orientación?

CINEMÁTICA INVERSA:

Para pasar de una posición a otra ¿qué movimientos de los ejes de un robot deben realizarse?

El tipo de configuración afecta fuertemente a la cinemática

Dirección diferencial: (giro sobre sí mismo)

Dirección tipo coche: (no giro sobre sí mismo)

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 9

2.2.-- MOTORES DC: TIPOS MOTORES DC: TIPOS

TIPOS DE MOTORES

Motores DC• Motores de imán permanente (PM) (estátor)

• Con núcleo de hierro (rotor)

• Sin núcleo de hierro (rotor))• Motores sin escobillas (brushless)• Motores de campo bobinado

• Conexión serie• Conexión paralelo

• Motores paso a paso• De imán permanente (PM)• De reluctancia variable• Híbridos

Motores AC• Motores AC monofásicos• Motores AC trifásicos

Motores de imán permanente -PM- (estátor)

Motores paso a paso -PP-

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 10

2.2.-- MOTORES DC: FUNCIONAMIENTOMOTORES DC: FUNCIONAMIENTO

FUNCIONAMIENTO MOTOR DC -PM-

Ley de Lorentz Esquema de conmutación por escobillas

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 12

2.2.-- MOTORES DC: CARACTERMOTORES DC: CARACTERÍÍSTICAS (1)STICAS (1)

CURVAS VELOCIDAD PAR

Parámetros significativos

Tensión nominal del motor: V

Corriente sin carga: Io

Corriente de arranque: Is=V/R

Velocidad sin carga: No

Par de parada: Ts

Rendimiento máximo: ηmáx

Potencia máxima: Pmáx=1/4 No TsPAR

Rendimiento

Velocidad

angularIntensidadPotencia

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 13

2.2.-- MOTORES DC: CARACTERMOTORES DC: CARACTERÍÍSTICAS (2)STICAS (2)

VARIACIONES DE TENSIÓN EMPLEO DE REDUCTORAS

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 15

2.2.-- MOTORES DC: HOJAS TMOTORES DC: HOJAS TÉÉCNICASCNICAS

Motores de 22mm en Miniatura de Control d.c.Características TécnicasCódigo RS 323-4896 323-4903 Potencia nominal (W) 5 5Tensión nominal (V) 6 12Velocidad sin carga (rpm) 8.760 9.970Par de parada (mNm) 20,7 22,6Velocidad (rpm) 5.800 6.600Velocidad máx. permisible (rpm) 10.600 10.600Corriente sin carga (mA) 169 10,4Corriente máx. continua (mA) 666 371Par máx. continuo (mNm) 6,48 6,34Dimensiones (mm)long. del cuerpo 31,9 31,9Ø del cuerpo 22 22Ø del eje 2 2

Unidades por Lote = 1 tipo código RS precio unitario Euros

1-4 5-9 10+6V 323-4896 35 30 2512V 323-4903 35 30 25

www.amidata.es

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 17

2.2.-- MOTORES DC: KIT PRMOTORES DC: KIT PRÁÁCTICOCTICO

MOTORES DE JUGUETES

• Rendimientos pobres

• Precios muy reducidos y fáciles de conseguir.

• Fácil de configurar mecánicamente

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 18

2.2.-- MOTORES DC: KIT PRMOTORES DC: KIT PRÁÁCTICO (2)CTICO (2)

MODIFICACIÓN DE SERVOMOTORES DE MODELISMO

• Uso como motor normal (requiere modificaciones)

• Uso como control de posición.

•Disponibles en tiendas de modelismo (baratos)

• Llevan reductora

• Ejemplos::

• Mabuchi

•Futaba

Desoldar módulo de control de posición

Eliminar pestillo de realimentación mecánica

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 19

MOTORES DC: ControlMOTORES DC: Control

DRIVER DE POTENCIA• Los circuitos digitales no pueden generar la

corriente que necesita un motor para funcionar• Se utiliza un circuito de potencia adaptador• El driver puede estar formado por componentes

discretos o por un circuito integrado• En control digital los drivers se comportan como

interruptores

Motor

Tensión de alimentación

del motor

Control

Tensión de alimentación

del motor

Control

Motor

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 20

2.2.-- MOTORES DC: CIRCUITOS DE EXCITACIMOTORES DC: CIRCUITOS DE EXCITACIÓÓN LINEALESN LINEALES

DRIVER LINEAL

• Basado en AOs de potencia (L165, L272, ...).

• El driver disipa bastante potencia al trabajar en zona lineal. ¡Sólo útil para bajas corrientes!

• No hay ruidos de conmutación

• No es fácil el interfaz con microcontroladores (DAC)

Vcc

R1R2

R1R2 R R R

R

M_+

_

+

Im = Ve · R2 / (R1·Rs)

±VinRs

Vcc

VM

En corriente

Vcc

R1R2

R1R2 R R R

R

M_+

_

+

Vm = Ve · (R2 / R1)

±Ve

En tensión

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 21

2.2.-- MOTORES DC: EXCITACIMOTORES DC: EXCITACIÓÓN CON PUENTE EN H (I)N CON PUENTE EN H (I)

CONTROL DEL SENTIDO DE GIRO (I)• Se utiliza un Puente en H que se implementa con cuatro

interruptores• Los interruptores se van abriendo de dos en dos• Nunca cerrar los dos de un mismo lado simultáneamente

Motor

Tensión de alimentación

del motor

Tensión de alimentación

del motor Motor

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 22

2.2.-- MOTORES DC: EXCITACIMOTORES DC: EXCITACIÓÓN CON PUENTE EN H (II)N CON PUENTE EN H (II)

Motor

Tensión de alimentación

del motor

Tensión de alimentación

del motor Motor

CONTROL DEL SENTIDO DE GIRO (II)• Se utiliza un Puente en H que implementa cuatro interruptores• Los interruptores se van abriendo de dos en dos• Nunca cerrar los dos de un mismo lado simultáneamente

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 23

2.2.-- MOTORES DC: EXCITACIMOTORES DC: EXCITACIÓÓN CON PUENTE EN H (III)N CON PUENTE EN H (III)

DRIVER NO LINEAL

• Basado en Puente en H: bien discreto, bien integrado (mejor para bajas potencias)

•El driver disipa poca potencia al trabajar los dispositivos en corte-conducción. ¡Útil para corrientes altas!

• Hay ruidos de conmutación• El interfaz con microcontroladores es más fácil (técnicas PWM)

Nivel alto: S1 y S4 conduciendo

Nivel bajo: S1 y S4 cortados

Trabajando con la diagonal S1-S4

Ciclo de trabajo:

D=ton/Tperiod

D=10%

D=40%

D=80%

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 24

2.2.-- MOTORES DC: PUENTE EN H (MODOS)MOTORES DC: PUENTE EN H (MODOS)

MODOS DE FUNCIONAMIENTO DEL PUENTE EN H CON DIODOS DE LIBRE CIRCULACIÓN: Necesario para trabajar con cambios de sentido de giro bruscos y a “contracarga”

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 25

2.2.-- MOTORES DC: PUENTE EN H MOTORES DC: PUENTE EN H ¿¿BIPOLAR O UNIPOLAR?BIPOLAR O UNIPOLAR?

BIPOLAR

• Control por corriente de base.

• Mayores pérdidas (caída de tensión en saturación de 1 - 1,5 V)

• Diodos de libre circulación aparte del BJT

UNIPOLAR

• Control por tensión (Vgsdel orden de 10 V). ¡Mayores tensiones de alimentación!

• Menores pérdidas (en conducción Ron de décimas de ohmio).

• Diodos de libre circulación integrados en el MOSFET

Si fuese canal N

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 26

2.2.-- MOTORES DC: PUENTE EN H (MOSFET MOTORES DC: PUENTE EN H (MOSFET --L6202L6202--))

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 27

2.2.-- MOTORES DC: PUENTE EN H (MOTORES DC: PUENTE EN H (BJTsBJTs --L293L293--))

Puente completo (para un motor)

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 28

2.2.-- MOTORES DC: PUENTE EN H (Modos de excitaciMOTORES DC: PUENTE EN H (Modos de excitacióón)n)

+V+V +V

PWMSIGNO

PWMSIGNO

PWM

a) b) c)

SIGNO: Selecciona una diagonal (sentido del motor)

PWM: Modula la conducción de sólo uno de los transistores de una diagonal.

SIGNO: Selecciona una diagonal (sentido del motor)

PWM: Modula la conducción de los dos transistores de una diagonal.

SIGNO: Implícito en la señal PWM (según el ciclo de trabajo esté por debajo o por encima del 50%)

PWM: Modula la conducción alterna de ambas diagonales.

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 29

2.2.-- MOTORES DC: PUENTE EN H (PWM+Sentido)MOTORES DC: PUENTE EN H (PWM+Sentido)

• Se selecciona el sentido de giro con la señal SIGNO

• Para cada sentido de giro la señal PWM puede variar con ciclos de trabajo 0<D<1

PWM SIGNO

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 30

2.2.-- MOTORES DC: PUENTE EN H (SMOTORES DC: PUENTE EN H (Sóólo PWM y ENABLE)lo PWM y ENABLE)

• La señal de ENABLE bloquea el funcionamiento del puente

• El sentido de giro va implícito en la señal PWM:

• 0<D<0,5 un sentido

• 0,5<D<1 otro sentido

• D=0,5 motor parado

ENABLE PWM

D=20% V medio negativaVmotor

t

Vmotor

t

D=80% V medio positiva

t

D=50% V medio nulaVmotor

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 31

2.2.-- MOTORES DC: PUENTE EN H (GeneraciMOTORES DC: PUENTE EN H (Generacióón PWM)n PWM)

COMPARACIÓN ANALÓGICA

Oscilador: generador de rampa

+

-

PWMSeñal de consigna (analógica)

COMPARACIÓN DIGITAL

Contador cíclico de N bits

PWM

CLK

Registro de consigna (N bits)Micro

Comparador digital de N bits

B

A

A>B

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 32

3.3.-- MOTORES DC: SENSADO Y LIMITACIMOTORES DC: SENSADO Y LIMITACIÓÓN DE CORRIENTEN DE CORRIENTE

MOTOR 1

MOTOR 2

RESISTORES DE SENSADOCOMPARADORES

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 33

2.2.-- MOTORES DC: ENCODERSMOTORES DC: ENCODERS

FUNDAMENTO• Una rueda con zonas homogéneas que dejan pasar una radiación

FABRICACIÓN “CASERA”

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 34

2.2.-- MOTORES DC: CONTROL EN LAZO CERRADOMOTORES DC: CONTROL EN LAZO CERRADO

EJEMPLO PARA CONTROL DE DIRECCIÓN DIFERENCIAL

Garantiza la velocidad ante irregularidades del terreno o cambios de par en las ruedas

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 35

2.2.-- SERVOMOTOR: CONTROL DE POSICISERVOMOTOR: CONTROL DE POSICIÓÓNN

• Permiten un control de posición entre determinados ángulos

• Fácil interfaz desde un microcontrolador.

•Muy útil en control de direcciones (triciclo), orientación de sensores, moviemientos de patas, etc.

INTERFAZ A TRES HILOS:

• Alimentación

• Masa

• Control

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 36

3.3.-- MOTORES PASO A PASO: FUNCIONAMIENTOMOTORES PASO A PASO: FUNCIONAMIENTO

FUNCIONAMIENTO BÁSICO DE UN MOTOR P-P (imán permanente)

Se excita sólo la bobina 1 en sentido A-B

Se excita sólo la bobina 2 en sentido D-C

Se excita sólo la bobina 1 en sentido B-A

Se excita sólo la bobina 2 en sentido C-D

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 37

3.3.-- MOTORES PASO A PASO: OTROS TIPOSMOTORES PASO A PASO: OTROS TIPOS

RELUCTANCIA VARIABLE

HÍBRIDOS

En cualquier caso el objetivo es aumentar el número de pasos por vuelta

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 38

3.3.-- MOTORES PASO A PASO: MODOS DE TRABAJOMOTORES PASO A PASO: MODOS DE TRABAJO

MEDIO PASO: Bobinas excitadas simultáneamente

PASO COMPLETO: Bobinas excitadas independientemente

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 39

3.3.-- MOTORES PASO A PASO: MODOS DE EXCITACIMOTORES PASO A PASO: MODOS DE EXCITACIÓÓNN

EXCITACIÓN BIPOLAR: Bobinas excitadas por los extremos

PUENTE EN HPUENTE EN H

CA B D

EXCITACIÓN UNIPOLAR: Bobinas excitadas por toma intermedia

CA B D

Vcc

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 40

3.3.-- MOTORES PASO A PASO: EXCITACIMOTORES PASO A PASO: EXCITACIÓÓNN

EXCITACIÓN CON CIRCUITO DEDICADO

• T: Cada pulso indica un paso (regula velocidad de giro y posición final)

• S: Sentido de giro

•R: Señal de ENABLE

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 41

3.3.-- MOTORES PASO A PASO: EXCITACIMOTORES PASO A PASO: EXCITACIÓÓNN

• Ahora las señales de control se deben generar en el microcontrolador

EXCITACIÓN CON DRIVER ULN2003: Modo unipolar EXCITACIÓN CON PUENTE EN H L293:

Modo bipolar

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 42

BATERBATERÍÍAS: RequerimientosAS: Requerimientos

PARÁMETROS A CONSIDERAR DE UNA BATERÍA:

• Recargabilidad: muy interesante en robots móviles

• Tensión de la batería: Va descendiendo a medida que se descarga la batería.

• Corriente descarga (el valor máximo está impuesto por la resistencia interna en caso de cortocircuito)

• Densidad de energía o cantidad de energía que almacenan por unidad de masa (en w·h / kg )

• Capacidad de la batería: Indica la cantidad de energía almacenada y disponible para la aplicación.

LA CAPACIDAD SE MIDE EN mA·h

Por ejemplo, una batería de 5000 mA·h podría estar suministrando 5A durante una hora ó 100 mA durante 50 h.

• Deben proporcionar la energía que requieren:

• los sistemas electrónicos (alimentados con tensión constante)

• Los motores (con corrientes relativamente altas y variables en el tiempo)

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 43

BATERBATERÍÍAS: Cuadro comparativoAS: Cuadro comparativo

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 44

BATERBATERÍÍAS: Curvas de descarga y tamaAS: Curvas de descarga y tamaññosos

BATERÍAS

PORTABATERÍAS

CURVA DE DESCARGA

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 45

BATERBATERÍÍAS: Algunas consideracionesAS: Algunas consideraciones

En cuanto a tensión para los sistemas electrónicos lo normal es: 3V ó 5V

(Los circuitos digitales HC “toleran” la descarga de la batería (funcionan de 2 a 5 V)

Con tensiones de 3V se reducen los consumos pero hay que cuidar más la implementación para evitar la incidencia de ruidos externos.

Puede ser interesante emplear una batería independiente para alimentar los motores (dependiendo de la tensión de los mismos y de las necesidades de corriente)

Usar baterías recargables, incluso aprovechando las de los equipos de video, teléfonos móviles, etc.

Los circuitos analógicos pueden ser “muy sensibles” a variaciones de la alimentación por lo que puede ser útil el empleo de un regulador.

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 46

BATERBATERÍÍAS: AS: ¿¿Como alimentar los circuitos?Como alimentar los circuitos?

• Evitar que las corrientes de los motores “pasen” por los hilos de alimentación de otros circuitos

Circuitos para sensores, conversión A/D, etc.

Puente en H

Sistema digital (micro, generación PWM, etc.)

BATERÍA NOCircuitos para sensores, conversión A/D, etc.

Puente en H

Sistema digital (micro, generación PWM, etc.)

BATERÍA

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 47

BATERBATERÍÍAS: AS: ¿¿Como alimentar los circuitos?Como alimentar los circuitos?

• Deben evitarse lazos de masa en el trazado

• Deben emplearse bastantes condensadores de desacoplo e incluso dos alimentaciones.

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 48

BIBLIOGRAFBIBLIOGRAFÍÍAA

•Páginas de internet de fabricantes y distribuidores de motores y circuitos integrados:

• www.st.com (SGS-Thomson)

• www.unitrode.com (Unitrode)

•www.amidata.es (RS-Amidata)

• www.futaba.com (Futaba)

•Apuntes y libros de asignaturas de “Electrónica de Potencia” y “Sistemas Electrónicos de Control” del Dpto de Electrónica, incluyendo página WEB: www.depeca.alcala/docencia

•Libros sobre micro-robots:

• “Mobile Robots: Inspiration to implementation” J.L. Jones y A.M. Flynn. Ed. A K Peters. 1993.

• “Microbótica”. Angulo y otros. Ed. Paraninfo. 1999.

Marzo 2006 SEMINARIO ALCABOT'2006 e HISPABOT'06 49

GRACIAS POR LA ATENCIGRACIAS POR LA ATENCIÓÓNN

Muchas gracias por la atención