Tesis de Grado
Tesis de Grado
Tesis de Grado
Director
CARLOS BORRAS PINILLA
Doctor, Ingeniero Mecnico
Para constancia se firma el presente documento en dos (02) ejemplares del mismo valor y
tenor, en Bucaramanga, a los dos das del mes de mayo de Dos Mil Once (2011)
.
EL AUTOR /ESTUDIANTE:
Para constancia se firma el presente documento en dos (02) ejemplares del mismo valor y
tenor, en Bucaramanga, a los dos das del mes de mayo de Dos Mil Once (2011).
.
EL AUTOR /ESTUDIANTE:
A mi familia, primos Castro, Cifuentes, Zalda, tos, abuelos, Ana Judith, Vivi y
A mis amigos, Jhon, Mara Fernanda, Nicols, Javier, Germn, Ana mara,
Ral, Marco, Felipe, Jimmy, Moiss, Johana, Tato, Ricardo, Olga, Melisa,
Claudia y Nancy entre otros, que me han acompaaron en las diferentes
etapas de mi vida, los hago participes de mis logros y alegras, espero se
adueen de ellos como si fueran propios. No sera tan feliz sin por lo menos
uno de los momentos compartidos con cada uno de ellos.
Diego Castro
Jhon Pea
AGRADECIMIENTOS
CONTENIDO
Pg.
INTRODUCCIN .............................................................................................. 26
ANTECEDENTES ............................................................................................. 28
MARCO TERICO ........................................................................................... 37
1
1.2
1.3
1.3.1
1.3.2
2.2
2.2.1
2.2.2
Sensores ....................................................................................... 74
2.2.3
2.2.4
2.2.5
2.2.6
2.3
2.3.1
2.3.2
2.4
2.4.1
2.4.2
3.2
10
3.3
3.4
3.5
3.6
4.2
4.3
4.4
4.5
4.6
4.7
4.8
4.9
5.1.1
5.1.2
Parmetros del
5.1.3
5.2
5.2.1
5.2.2
5.3
5.3.1
6
............................................................. 149
6.2
6.2.1
6.2.2
6.2.3
6.3
6.4
11
6.4.1
6.4.2
6.4.3
6.4.4
6.4.5
6.4.6
6.4.7
6.5
6.5.1
6.5.2
6.6
7
7.1.1
7.2
CARACTERSTICAS................................................................... 198
7.2.1
7.2.2
7.3
7.3.1
7.3.2
7.3.2.1.
7.3.2.2.
7.3.2.4.
7.3.2.5.
7.3.2.6.
7.3.2.7.
7.3.2.8.
7.3.2.9.
12
7.4.2.
7.5.
7.5.2.
8.4.
8.5.
8.6.
8.7.
8.8.
8.9.
8.10.
253
13
LISTA DE TABLAS
Pg.
Tabla 1. Datos Segway i2 y x2.
29
32
83
90
91
92
95
96
97
99
100
102
104
106
108
120
130
Tabla 19. Constantes del control PD, y parmetros del sistema de control.
136
165
168
171
175
178
179
180
Tabla 27. Torques requeridos por cada motor para diferentes inclinaciones. 181
14
187
188
189
192
193
195
212
222
245
15
LISTA DE FIGURAS
Pg.
Figura 1. Segway i2 y x2 usados por Policas Colombianos.
28
30
31
33
33
34
35
36
38
39
40
40
43
44
44
47
47
48
49
51
52
53
53
54
54
55
16
56
59
59
71
72
74
75
77
80
86
87
88
88
89
89
93
93
94
95
96
99
100
101
102
17
103
103
105
107
108
109
110
111
112
113
116
116
117
118
119
120
121
123
124
125
131
133
133
134
135
135
136
136
18
140
Figura 81. (A) Caracterstica de un controlador On-Off ideal, (B) con Zona
muerta y (C) Histresis.
141
142
146
152
154
155
155
156
156
157
157
161
162
163
164
165
166
Figura 98. Representacin en Ansys de los soportes de los tubos riel, Anlisis
deformacin y esfuerzos respectivamente.
167
168
169
19
170
172
172
173
174
175
176
176
177
179
Figura 111. Fotografa del motor BANEBOTS, usado en el montaje final del
VEAU.
180
183
184
185
186
188
189
190
20
191
193
194
195
196
197
200
203
204
209
210
Figura 130. Sistema de control de lazo cerrado bsico, con las funciones de
cada bloque que lo compone.
213
215
219
224
225
225
229
230
231
233
233
234
235
237
21
239
241
241
242
243
22
LISTA DE ANEXOS
Pg.
252
257
263
274
278
283
23
RESUMEN
TITULO: DISEO Y CONSTRUCCIN DE UN PROTOTIPO EXPERIMETAL DE UN
VEHCULO ELECTRICO AUTOBALANCEADO UNIPERSONAL VEAU*.
Resumen
Proyecto de Grado
Facultad de Ingenieras fisicomecnicas. Escuela de Ingeniera Mecnica. Director: Carlos Brras
Pinilla.
**
24
ABSTRACT
ABSTRACT
This document presents the initial development phase about an electric auto balanced
vehicle for one person of one shaft. It has a main characteristic: the use of two
concentric wheels (parallel), one on each side, the system generates a state of
unstable equilibrium, which is controlled by the implementation of a PID filter; also, the
system automatically activates the combined motors each of the wheels, according to
the inclination that the user produces in the vehicle.
This vehicle is the first type of devices in the country, that is why, it was fundamental to
realize a dynamic analysis using the development of the software by using
mathematical tools as matlab- simulink, with the objective of knowing the behavior and
variable of state that define the control of the vehicle. This analysis allowed to do a
selection of the devices that compose the hardware, when it was integrated with the
software, it developed a reliable and efficient robust control unit.
The final aim of the project is to create a vehicle that it has a beneficial impact as
regards the problems of traffic and pollution that the big cities are presenting right now.
Also, this vehicle is a direct solution to the problems of mobility because it exists a big
percentage of people that they present motor diminished skills such as: people that
they have had serious injuries of spinal cord or in common accidents.
Work Degree
Faculty Physic Mecanic. Mecanic Engineer School. Director: Carlos Brras Pinilla.
**
25
INTRODUCCIN
Uno de los problemas que se presentan en las grandes ciudades estn
relacionados con la industria del transporte, entre estos se encuentran la gran
cantidad de trfico y contaminacin que esta genera, ya que los automviles
que funcionan con motores de combustin interna, aportan considerables
partculas contaminantes al ambiente, llevando al colapso del trfico y
empeorando ampliamente la calidad del aire en las ciudades, produciendo
graves enfermedades, disminuyendo la calidad de vida de los ciudadanos.
mismo espacio que una persona, el manejo del vehculo es sencillo y requiere
de poco tiempo para aprenderlo manejar.
Adems del impacto favorable que presenta este vehculo respecto a los
problemas de trfico y contaminacin, este vehculo es una solucin directa a
los problemas de movilidad que tienen un gran porcentaje de personas que
presentan capacidades motoras disminuidas, como personas que han sufrido
lesiones de medula espinal y accidentes. Este trabajo se enfoc al diseo y
construccin de un prototipo de vehculo elctrico autobalanceado para
personas con capacidades disminuidas motoras, adems de presentar una
alternativa a los problemas ecolgicos y de transporte ya mencionados.
27
ANTECEDENTES
SEGWAY [1]
Modelo
Segway i2
Segway x2
Peso
Tamao Ruedas
Tamao Base
Velocidad mxima
Autonoma
Motores
47.7 [kg]
19
48x63 [cm]
20 [km/hr]
38 [km]
Brushless
54.4 [kg]
33
53x84 [cm]
20 [km/hr]
19 [km]
Brushless
Sin
embargo,
este
vehculo
no
logr
el
xito
comercial
esperado,
www.segway.com/puma
29
De este modo, a pesar del aparente poco xito del vehculo, se gener una
interesante rea de desarrollo de vehculos personales que llam la atencin
de muchos desarrolladores, generando una serie de prototipos que emulan el
equilibrio humano basados en estructuras anlogas al pndulo invertido,
ampliando la definicin del vehculo como un modelo en particular de una
compaa a una categora de medio de transporte.
31
Modelo
Versin 1
Versin 2
Peso
Tamao Ruedas
Velocidad Mxima
Motores
40.8 [kg]
14
14.5 [km/hr]
CC con imanes
31.75 [kg]
20
24 [km/hr]
CC con imanes
32
33
34
Este vehculo fue desarrollado por Leonardo Felipe Moreno Bustamante como
trabajo de grado para optar al ttulo de Ingeniero Civil Electricista de la
35
36
MARCO TERICO
MOTORES DC2
El motor de corriente continua es una mquina que convierte la energa
elctrica en mecnica, principalmente mediante el movimiento rotatorio. Esta
mquina de corriente continua es una de las ms verstiles en la industria. Su
fcil control de posicin, paro y velocidad la han convertido en una de las
mejores opciones en aplicaciones de control y automatizacin de procesos.
La principal caracterstica del motor de corriente continua es la posibilidad de
regular la velocidad desde vaco a plena carga.
Una mquina de corriente continua (generador o motor) se compone
principalmente de dos partes, un estator que da soporte mecnico al aparato y
tiene un hueco en el centro generalmente de forma cilndrica. En el estator
adems se encuentran los polos, que pueden ser de imanes permanentes o
devanados con hilo de cobre sobre ncleo de hierro. El rotor es generalmente
de forma cilndrica, tambin devanado y con ncleo, al que llega la corriente
mediante dos escobillas.
El motor de corriente continua est compuesto de 2 piezas fundamentales que
se ilustran en la figura 9.
Rotor
Estator
Fuente www.todorobot.com.ar
37
38
Las laminaciones tienen por objeto reducir las corrientes parsitas en el ncleo.
El acero del ncleo debe ser capaz de mantener bajas las prdidas por
histresis. Este ncleo laminado contiene ranuras a lo largo de su superficie
para albergar al devanado de la armadura (bobinado).
Devanado: Consta de bobinas aisladas entre s y entre el ncleo de la
armadura. Estas bobinas estn alojadas en las ranuras, y estn conectadas
elctricamente con el colector, el cual debido a su movimiento rotatorio,
proporciona un camino de conduccin conmutado.
Colector: Denominado tambin conmutador, est constituido de lminas de
material conductor (delgas), separadas entre s y del centro del eje por un
material aislante, para evitar cortocircuito con dichos elementos. El colector se
encuentra sobre uno de los extremos del eje del rotor, de modo que gira con
ste y est en contacto con las escobillas. La funcin del colector es recoger la
tensin producida por el devanado inducido, transmitindola al circuito por
medio de las escobillas (llamadas tambin cepillos)
39
Estator
Constituye la parte fija de la mquina. Su funcin es suministrar el flujo
magntico que ser usado por el bobinado del rotor para realizar su
movimiento giratorio, la figura 11 ilustra el estator de un motor DC.
Est formado por:
Armazn: Denominado tambin yugo, tiene dos funciones primordiales: servir
como soporte y proporcionar una trayectoria de retorno al flujo magntico del
rotor y del imn permanente, para completar el circuito magntico (Ver figura
12).
40
MICROCONTROLADOR3
Un Microcontrolador es Circuito integrado o chip que incluye en su interior las
tres unidades funcionales de un ordenador: CPU, Memoria y Unidades de E/S,
es decir, se trata de un computador completo en un solo circuito integrado.
Aunque sus prestaciones son limitadas, adems de dicha integracin, su
caracterstica principal es su alto nivel de especializacin. Aunque los hay del
tamao de una moneda, lo normal es que sean incluso ms pequeos, ya que,
lgicamente, forman parte del dispositivo que controlan.
3
http://www.olimex.cl/present.php?page=que_es_un_microcontrolador
41
De
la
Figura
13
observamos,
que
sin
importar
el
fabricante
del
42
ARDUINO4
Arduino es una plataforma de hardware libre basada en una sencilla placa de
entradas y salidas simple y un entorno de desarrollo que implementa el
lenguaje de programacin Processing/Wiring. Arduino se puede utilizar para
desarrollar objetos interactivos autnomos o puede ser conectado a software
del ordenador (por ejemplo: Macromedia Flash, Processing, Max/MSP, Pure
Data). Las placas se pueden montar a mano o adquirirse. El entorno de
desarrollo integrado libre se puede descargar gratuitamente.
Las plataformas Arduino estn basadas en los microcontroladores Atmega168,
Atmega328, Atmega1280, ATmega8 y otros similares, chips sencillos y de bajo
coste que permiten el desarrollo de mltiples diseos.
www.arduino.cc
43
OPTO-ACOPLADOR
Un opto-acoplador, tambin llamado optoaislador o aislador acoplado
pticamente, es un dispositivo de emisin y recepcin que funciona como un
interruptor excitado mediante la luz emitida por un diodo LED que satura un
componente optoelectrnico, normalmente en forma de fototransistor o
fototriac. De este modo se combinan en un solo dispositivo semiconductor, un
45
46
47
AMPLIFICADOR OPERACIONAL
Bsicamente el Amp. Op. (Op. Amp.) es un dispositivo amplificador de la
diferencia de sus dos entradas, con una alta ganancia, una impedancia de
entrada muy alta, (mayor a 1 Mega ohm) y una baja impedancia de salida (de 8
a 20 ohmios).
Con estas caractersticas se deduce que las corrientes de entrada son
prcticamente nulas y que tiene la caracterstica de poder entregar corriente
relativamente alta. En la Figura 18 se ve el smbolo elctrico de un amplificador
operacional.
48
FILTROS
Un filtro elctrico o filtro electrnico es un elemento que discrimina una
determinada frecuencia o gama de frecuencias de una seal elctrica que pasa
a travs de l, pudiendo modificar tanto su amplitud como su fase.
Tipo de filtros:
Filtro paso bajo: Es aquel que permite el paso de frecuencias bajas, desde
frecuencia 0 o continua hasta una determinada. Presentan ceros a alta
frecuencia y polos a bajas frecuencia.
49
Filtro paso alto: Es el que permite el paso de frecuencias desde una frecuencia
de corte determinada hacia arriba, sin que exista un lmite superior
especificado. Presentan ceros a bajas frecuencias y polos a altas frecuencias.
Filtro paso banda: Son aquellos que permiten el paso de componentes
frecuenciales
contenidos
en
un
determinado
rango
de
frecuencias,
50
51
es negativo, algunos de los electrones del areal del canal n sern repelidos
y se creara una regin de agotamiento por debajo de la capa de xido que
resultara en un canal efectico ms angosto y en una resistencia de drenaje
para la fuente, Rds. Si Vgs se hace suficientemente negativo, el canal se
agotar totalmente, ofreciendo un alto valor de RDS, y no habr flujo de
corriente de drenaje a fuente, Ids =0. Cuando esto ocurre el valor de Vgs se
conoce como voltaje de estrechamiento, Vp. Por otra parte, Vgs se hace
positivo, el canal se ensancha y la corriente Ids aumenta debido a la reduccin
de Rds. Con un MOSFET de Agotamiento de canal P, las polaridades de Vds,
Ids y Vgs se invierten.
52
53
PUENTE H5
Un puente H adopta la letra H, por ello su nombre debido a la forma que
presenta dentro de un circuito esquemtico simplificado, como el que se ve en
la Figura 26. En la barra central se encuentra ubicado el motor y en cada rama
lateral ascendente o descendente se ubican los conmutadores que, activados
de manera apropiada, brindarn al sistema los movimientos necesarios para
que el motor utilizado pueda girar en un sentido u otro
5
www.neoteo.com
54
55
con
anterioridad.
Algunos
diseadores
prefieren
utilizar
56
Figura 28. Los interruptores reemplazados por transistores MOSFET dentro del puente H y la circulacin
de corriente para lograr los dos sentidos de giro.
57
corriente a travs de Drain Source para hacer girar el motor al mximo, con
una diferencia de potencial de 2 Volts o ms entre estos dos terminales del
transistor.
Esto equivale, segn la frmula de potencia, que 2 Volts multiplicados por la
mxima corriente del motor ser una potencia que disipar en forma de calor
en el transistor. Cuanto mayor sea la corriente para hacer funcionar el motor,
mayor ser el calor generado por los transistores, por lo tanto, mayor ser el
tamao de los disipadores.
Muchos
diseadores
prefieren
evitar
estos
inconvenientes
utilizando
transistores de canal P en las ramas superiores del puente H, pero ocurre que
estos dispositivos son ms caros y difciles de conseguir que los de canal N.
PWM
La modulacin por ancho de pulsos (tambin conocida como PWM, siglas en
ingls de pulse-width modulation) de una seal o fuente de energa es una
tcnica en la que se modifica el ciclo de trabajo de una seal peridica (una
senoidal o una cuadrada, por ejemplo), ya sea para transmitir informacin a
travs de un canal de comunicaciones o para controlar la cantidad de energa
que se enva a una carga.
Los parmetros fundamentales del PWM son el periodo (T) y el ciclo de trabajo
o duty cycle (D). El ciclo de trabajo indica el tiempo que la funcin vale uno
respecto al tiempo total (el periodo). La figura 29 muestra tres ciclos de trabajo
distintos. Observa que el periodo del PWM se mantiene constante, y lo que
cambia es el tiempo en que la seal se mantiene a uno respecto al periodo
total.
58
59
BATERAS6
Batera, batera elctrica, acumulador elctrico o simplemente acumulador, se
le
denomina
al
dispositivo
que
almacena
energa
elctrica,
usando
los
dispositivos
electroqumicos
semi-reversibles,
Tipos de bateras
http://es.wikipedia.org/wiki/Bater%C3%ADa_(electricidad)
60
excesivo,
al
estar
compuesta
principalmente
de
plomo,
61
63
pueden
cargarse
sin
necesidad
de
estar
descargadas
Pilas de combustible
La pila de combustible no se trata de un acumulador propiamente dicho,
aunque s convierte energa qumica en energa elctrica y es recargable.
Funciona con hidrgeno. (Otros combustibles como el metano o el metanol son
usados para obtener el hidrgeno).
64
65
1.1
Las personas que tras sufrir una lesin de mdula espinal (SCI), amputacin de
miembro(s) inferior(es) o dao en sus piernas, adems el aporte de pacientes
que genera el conflicto armado en Colombia que por diversas circunstancias
han disminuido su capacidad motora, aquellas presentan una significativa
disminucin en su calidad de vida. De igual forma ocurre con la personas de
tercera edad que se ven obligadas a disminuir aquellas actividades cotidianas
que implican un desplazamiento que normalmente realizaban caminando. Para
mejorar la calidad de vida de aquellas personas cuya
capacidad este
66
1.2
1.3
1.3.1
Objetivo General
67
1.3.2
Objetivos Especficos
de
una
tarjeta
de
control
embebida,
basada
en
el
68
69
de
dos
actuadores
para
poder
seleccionaron
basndonos
en
tablas
70
de
seleccin
que
indican
2.1
REQUERIMIENTOS DE DISEO
). Este parmetro es la
71
PARTE OPERATIVA
72
73
2.2.2 Sensores
74
75
y compas
matemtico
para
las
mltiples
integraciones
numricas
y la
76
). El
Vale resaltar que este valor de inclinacin ser tan preciso como lo sea el
sensor utilizado, y que la aceleracin calculada sea nicamente la de la
gravedad, al no ser as, al incluirse aceleraciones externas debido a
movimientos bruscos del sensor, este incluir un error significativo en el valor
77
Se obtiene:
Esta integracin requiere de una condicin inicial que pueda ser dada por el
acelermetro, y la integracin se hace durante un periodo de tiempo constante
dt llamado tiempo de muestreo del sensor. Esta integracin numrica se hace
con ayuda de un microcontrolador.
Esta opcin tiene la gran ventaja respecto del acelermetro que las
aceleraciones externas no le afectan.
78
Este valor de
79
2.2.3
Voltaje
de
alimentacin
del
sensor
):
Es el
voltaje
que
80
Consumo de corriente (
Bajo consumo (
Rango (
81
Sensibilidad (
Offset (
alimentacin:
`
XY bandwidth (
82
83
2.2.4
84
(1)
(2)
85
Figura 37. Configuracin interna de los acelermetros de Analog Devices de la serie ADXL250
86
MEMS
(maquinas
micro
electromecnicas),
es
tecnologa
http://es.wikipedia.org/wiki/Sistemas_microelectromec.
87
88
89
de
alimentarse el pin 12, con 3.3 volts, el consumo de corriente aumentara a 500
, debido a que la autonoma del vehculo es un aspecto importante en los
vehculos de transporte, se mantendr el acelermetro en mode sleep, en
momentos donde el vehculo no necesite estabilizarse o cuando no est en
operacin.
90
Descripcin de pines
El dispositivo consta de 16 pines, tres son entradas lgicas, tres son salidas
analgicas y otros dos son alimentacin y tierra. El resto de pines quedan sin
conectar. De las entradas digitales, dos de ellas se dedican a la seleccin del
rango de aceleracin y la sensibilidad (g-Select1, g-Select2), y la otra es para la
seleccin del modo de consumo ( Sleep mode ). Las tres salidas analgicas
(XOUT,
YOUT,
ZOUT)
representan
niveles
de
tensin
anlogos
92
93
94
implicaciones en esta aplicacin, ya que dos ejes son necesarios para construir
el inclinmetro.
Las especificaciones para poder poner en correcto funcionamiento el
acelermetro ADXL320 y parmetros generales del sensor, se muestran en la
tabla 7.
95
Descripcin de pines
El dispositivo consta de 16 pines, dos son salidas analgicas, otros dos son
alimentacin y cuatros son de tierra. El resto de pines quedan sin conectar, Las
dos salidas analgicas (XOUT, YOUT) representan niveles de tensin anlogos
correspondientes a las aceleraciones en los ejes X, Y, respectivamente. Estas
tres seales presentan un offset igual a 1.2 V para alimentacin de 2.4, es
decir, este ser el valor de tensin que muestren en ausencia de aceleracin.
En la tabla 6 se muestra la configuracin de pines.
Debido a que este integrado fue diseado con encapsulado LFCSP, este debe
ser soldado especialmente, al no disponer del equipo de soldado para el PCB
de este acelermetro, se importo la versin en PCB que nos ofrece Sparkfun,
esta integra Las diferentes resistencias que se necesitan, la figura 47 ilustra el
acelermetro ADXL320 en PCB.
96
CARACTERSTICA
SMBOLO
FREESCALE
AD ADXL
UNIDAD
MMA7260
ALIMENTACIN
VDD
3.3
CONSUMO
IDD
500
400
BAJO CONSUMO
IDD
RANGO
gFS
1.5, 2, 4, 6
SENSIBILIDAD MAX
800
167
mV/g
OFFSET
VOff
1.65
1.65
XY BANDWIDTH
f-3dB
350
600
Hz
DIMENSIONES
6x6x1.45
4x4x1.45
mm
INTERFAZ
anloga
anloga
COSTO
19.95
29.95
DISPONIBLE
Nacional
Internacional
(importacin
$US
de
USA)
97
98
CARACTERSTICA
SMBOLO
MIN
TYP
MAX
UNIDADES
ALIMENTACIN
3.0
3.3
3.6
Volts
BAJO CONSUMO
11
14
mA
RANGO
0 - +/-180
0-360
SENSIBILIDAD
0.025
/LSB
BANDWIDTH
2250
Hz
99
Descripcin de pines.
En la tabla 11 se encuentra la descripcin de los pines del sensor de inclinacin
ADIS16203 en su vista superior con su descripcin de pines correspondiente.
100
Respuesta de salida.
El ngulo de inclinacin que suministra el ADIS16203, es lineal en grados y
suministra la inclinacin dependiendo de cmo sea su orientacin, as como lo
ilustra la figura 50.
101
2.2.5
102
103
El LISY300AL tiene una escala de 300 / s, capaz de medir las tasas con un
3 dB de ancho de banda de hasta 88 Hz. puede funcionar dentro de un rango
de temperatura de -40 C a +85 C.
En la tabla 13 se resumen las caractersticas principales del giroscopio
LISY300AL, para mayor informacin acerca de este sensor se encuentra el
datasheet del LISY300AL en el anexo F.
CARACTERSTICA
SMBOLO
LISY300AL
UNIDAD
ALIMENTACIN
3.3
CONSUMO
500
RANGO
300
/s
SENSIBILIDAD MAX
3.3
mV//s
OFFSET
1.65
XY BANDWIDTH
80
Hz
DIMENSIONES
7x7x1.5
mm
INTERFAZ
anloga
COSTO
19.95
DISPONIBLE
Nacional
$US
104
Adems ofrece una alta sensibilidad para un bajo rango de velocidad angular,
de 9.1 mV//s, esto es ideal para tarjetas de adquisicin de datos de baja
resolucin, el rango que ofrece a esta sensibilidad es de 110/s.
En la figura 54, se observa el diagrama de bloques que compone este sensor,
vemos porque este sensor posee tan altas prestaciones.
105
SMBOLO
IDG500
LISY300AL
UNIDAD
ALIMENTACIN
3.0
3.3
CONSUMO
500
mA
RANGO
500
300
/s
SENSIBILIDAD MAX
9.1
3.3
mV//s
OFFSET
1.35
1.65
XY BANDWIDTH
31
80
KHz
DIMENSIONES
4x5x1.2
7x7x1.5
mm
INTERFAZ
anloga
anloga
COSTO
39.95
19.95
DISPONIBLE
internacional
Nacional
$US
106
2.2.6
Actuadores
107
MODELO
NPC-T64
M4-R0062-12
226-3001
UNIDADES
VENDEDOR
NPC-Robotics
Banebots
AM-equipment
VOLTAJE
24
12
12
CAJA REDUCTORA
20:1
16:1
16:1
VELOCIDAD NOMINAL
230
5310
95.9
RPM
POTENCIA
0.7
0.46
0.3
HP
CORRIENTE NOMINAL
21
2.7A
3.4
CORRIENTE PICO
110 A
19.8
15.7
TORQUE MXIMO
93
2.4
15
N-m
2.3
PARTE DE CONTROL
108
2.3.1 Controlador
Figura 58. Placa de desarrollo Arduino mega, integrando un microcontrolador atmega128 de Atmel
109
2.3.2
Pre actuador
2.4
PUENTE H
110
111
2.4.1
Integrado L298N
113
Modelo
(mximo)
IRF48N
IRF4901
55 V
55 V
0.016
0.02
64 A
74 A
114
115
116
Figura 64. Esquema del puente H con transistores en paralelo y compuertas lgicas. Fuente: Los
autores.
117
3.1
MODELO MATEMATICO
, rotacin respecto al
. La
complejidad del control aumenta cuando se exija controlar cada uno de estos
tres grados de libertad, pero se debe buscar cual variable es la ms relevante y
118
Diseo e implementacin de un vehculo auto balanceado sobre dos ruedas; Leonardo Felipe
Moreno Bustamante.
119
TIPO
SIGNIFICADO
Variable
Variable
Variable
variable
Variable
Variable
Variable
Variable
variable
parmetro
parmetro
parmetro
Masa de la plataforma
parmetro
Masa de la rueda
parmetro
parmetro
parmetro
parmetro
Como las
ruedas se
(1)
(2)
121
(3)
(4)
(5)
(6)
122
Fuente: Grasser Felix, Darrigo Aldo, Colombi Silvio, Rufer Alfred; JOE: A Mobile Inverted Pendulum.
(8)
(9)
123
(10)
(11)
124
(12)
(13)
(14)
(15)
125
(16)
(17)
Al combinar las ecuaciones (14 a 16) y las ecuaciones (3 a 6) se obtienen las
siguientes ecuaciones dinmicas del sistema:
(17)
(18)
(19)
Las ecuaciones 17 a 19 permite obtener la relacin entre el desplazamiento y la
inclinacin, adems la relacin entre el giro del vehculo con las dems
variables del sistema, se pudo obtener una primera conclusin, el giro del
vehculo solo depende de la diferencia de torques entre los dos motores y no
depende de la inclinacin de la plataforma. Adems se observa la dependencia
del desplazamiento lineal con la inclinacin del vehculo.
3.2
126
(20)
(21)
(22)
127
(26)
(27)
(28)
Para hallar las acciones de control se debe hallar, el torque virtual necesario
para controlar la inclinacin del sistema y un torque virtual que controle el giro,
teniendo solo un torque por manejar, la simulacin del sistema se simplifica,
luego de hallar los torques virtuales se pudo obtener los torques suministrados
a cada motor con la inversa de la matriz de desacople:
129
, y los torques de
3.4
FUNCION DE TRANSFERENCIA
VALOR
UNIDAD
DESCRIPCIN
0.75
[m]
0.7/2=0.35
[m]
50
[Kg]
Masa de la plataforma
[kg]
Masa de la rueda
9.357
2.0417
0.0196
130
131
3.5
132
133
Este modelo tiene una entrada torque (es la variable que permite definir el
comportamiento del sistema es lo que se le introduce al sistema dinmico) y
dos salidas, ngulo de inclinacin y posicin, este modelo se introduce en un
bloque (subsystem) indicando las entradas y la salidas, se ilustra en la figura
75.
Para realizar el control del sistema se aplico un bloque de control PID, del cual
se excluyo la funcin integral, dejando solo un control PD, el setpoint del
sistema de control, se indica como una constante 0 que se resta con la seal
del sensor de inclinacin.
La perturbacin se simulo como un tren de pulsos, que se configuro para
suministrar una funcin escaln, esta perturbacin se integra en un punto de
suma con la salida que entrega el bloque PD, se introduce al bloque del
sistema, la figura 76 ilustra lo que se describe anteriormente.
134
T[S]
0.4
KP
KD
-1921.608
-75.75
[M/S]
0.65
25
0.25
Tabla 19. Constantes del control PD, y parmetros del sistema de control.
3.6
REQUERIMIENTOS TECNICOS
137
138
4.1
CONTROL PID
INTRODUCCION
4.2
EL PRINCIPIO DE REALIMENTACION
139
4.3
El
mecanismo
de
CONTROL ON-OFF
realimentacin
ms
simple
se
puede
describir
(29)
140
Figura 81. (A) Caracterstica de un controlador On-Off ideal, (B) con Zona muerta y (C) Histresis.
4.4
CONTROL PROPORCIONAL
141
4.5
ERROR ESTACIONARIO
142
On-Off, luego hay un lmite al cual se puede reducir la banda proporcional, por
lo tanto siempre habr error estacionario.
4.6
ACCIN INTEGRAL
4.7
ACCIN DERIVATIVA
4.8
144
(32)
En la prctica cualquier conjunto de valores cercano al ptimo brindar un
rendimiento aceptable y probablemente casi igual al ptimo.
Adems existe varios mtodos de sintonizacin de estas constantes, entre
estos los ms usados son los mtodos de Ziegler-Nichols, el cual es una buena
aproximacin de estos parmetros.
4.9
Siempre se busca que el sistema de control sea estable, pero adems, dentro
de las condiciones de estabilidad existen 3 tipos de comportamiento bien
definidos: control sub amortiguado, control con amortiguamiento crtico y
control sobre-amortiguado.
145
Figura 83. Ejemplos de comportamientos control sub amortiguado, control con amortiguamiento crtico y
control sobre amortiguado
146
grande.
147
5 IMPLEMENTACIN
5.1
PARAMETROS DE CONTROL
Posicin de Equilibrio: Hace referencia a la lnea vertical que pasa por el eje de
las ruedas y por el centro de masa del conjunto vehculo-pasajero.
Inclinacin : Es la variable principal del sistema, la cual puede ser medida con
diferentes sensores, tales como acelermetros, inclinmetros, sensores de
distancia, etc. Los sensores usados en este caso para las diferentes pruebas
fueron acelermetro e inclinmetro.
Velocidad de Inclinacin
148
5.1.1
Variable de Proceso
se pude expresar
como:
Donde
es la variacin
Parmetros del
Proporcional
este caso, el vehculo se inclina ms, la energa que le llega a los motores
tambin aumenta proporcionalmente en un factor
Derivativo
control del mando de salida para as obtener una respuesta del sistema ms
estable. De tal forma que si el ngulo medido (
punto de equilibrio (
. Ahora, si en un
a una cierta velocidad, el control se adelanta y enva una mayor potencia a los
motores para contrarrestar el impulso que lo lleva a una cada.
El clculo de este parmetro se calcula por medio de la expresin:
Donde
es la constante derivativa y el
150
Donde
5.1.3
Secuencia de control
151
5.2
5.2.1
Ubicacin
5.2.2
153
154
Figura 86. Ubicacin de los sensores en la parte superior del vehculo de pruebas.
155
En las figuras 90 y 91, se observan las seales de salida del los sensores,
acelermetro y giroscopio luego de ser sometidos a pequeas perturbaciones
(inclinacin hacia adelante y hacia atrs). En la figura 90 se observan 6 picos y
6 crestas correspondientes a pequeas pero rpidas inclinaciones a las que se
someti el sistema, se ve que la lnea azul correspondiente al acelermetro sin
filtros sigue notoriamente, aunque de forma ruidosa, el movimiento del sistema.
Al aplicar la etapa de filtrado digital y analgico, correspondiente a lnea verde,
156
157
5.3
5.3.1
158
se graduaron por
160
161
6.1
Figura 93. Bastidor junto con los componentes. Representacin hecha en SolidWorks.
162
Para su anlisis se tom en cuenta cada una de las cargas que actan sobre
estas barras, las cuales son el peso de cada uno de los sistemas que
componen el vehculo, el peso de la persona y la carga interna generada sobre
las barras por accin del torque de los motores. En las figura 97 se ve la
respuesta del sistema en cuanto a deformacin y esfuerzos en la parte superior
e inferior respectivamente, en la tabla 20 se listan las caractersticas principales
de este subsistema.
163
Figura 95. Representacin en Ansys de las barras de la estructura base, Anlisis deformacin y
esfuerzos respectivamente.
164
CARACTERSTICAS
Material: Acero Estructural Colmena.
AISI/SAE 1015
Esfuerzo Mximo: 22161 Psi
Esfuerzo Admisible: 46000 Psi
6.2
MECANISMO DE DESLIZAMIENTO
165
6.2.1 Soportes
Soportan los Tubos del Riel. Hechos de seccin cuadrada de un perfil de 1
(ver figura 97).
166
Figura 98. Representacin en Ansys de los soportes de los tubos riel, Anlisis deformacin y esfuerzos
respectivamente.
167
CARACTERSTICAS
Material: Acero Estructural Colmena
AISI/SAE 1015.
Dimensiones: 45 x 25.4 x 25.4 mm,
espesor de pared 2.5 mm
Factor de Seguridad: Superior a 15.
6.2.2
Tubos Riel
Figura 99. Tubo Riel del mecanismo de deslizamiento. Representacin hecha en SolidWorks.
168
169
Figura 101. Representacin en Ansys de los Tubos Riel, Anlisis deformacin y esfuerzos
respectivamente.
170
CARACTERSTICAS
Material: Aluminio, Almina
Dimensiones: Longitud 360 mm
Dimetro 1
Espesor de pared 1.5 mm
Factor de Seguridad: 2.95
Carga Aplicada: Dos fuerzas en sus
extremos de 25 Kg cada una.
Tabla 22. Caractersticas Tubo Riel.
6.2.3
Rodillos
Este sistema permite el deslizamiento del sub conjunto Silla junto con el
pasajero logrando hacer que el sistema se incline. Los rodillos estn fabricados
en Nylon y van soportados sobre un par de rodamientos 608Z (ver figura 102),
usados comnmente para ruedas de patines. Se eligi este tipo de rodamiento
por varias razones. Aun cuando en el VEAU solo estarn sometidos a unos
pocos
171
172
Para el anlisis en ANSYS Workbench se uso una carga sobre el rodillo de 250
N. Para lo cual se obtuvo un factor de seguridad de N = 13,9. La figura 105
muestra el comportamiento en cuanto a deformacin y esfuerzo bajo carga de
este componente, la tabla 23 muestra las caractersticas principales de los
rodillos.
173
174
CARACTERSTICAS
Material: Nylon
Factor de Seguridad: 13,9.
Carga Aplicada: 25 Kg.
6.3
Figura 106. Soporte Bateras junto con sus componentes ms cercanos. Representacin hecha en
SolidWorks.
175
176
Figura 109. Representacin en Ansys del Soporte de las Bateras, Anlisis deformacin y esfuerzos
respectivamente.
177
CARACTERSTICAS
Material: Aluminio. Almina.
Dimensiones: 315 x 215 x 19 mm, espesor
de pared 3 mm
Factor de Seguridad: Superior a 15.
Carga Aplicada: 30500 Pa.
Motor DC
178
Figuras 110. Representacin en SolidWorks y Fotografa de uno de los motores usados en el modelo de
pruebas.
CARACTERSTICAS
Motoreductor DC MATSUHITA de 24
Voltios con encoder.
Reduccin de 16:1 Piones
Corriente pico: 15 A
179
Figura 111. Fotografa del motor BANEBOTS, usado en el montaje final del VEAU.
CARACTERSTICAS
Moto reductor DC BANEBOTS de 12 Voltios
Reduccin de 16:1 planetaria.
Corriente sin Carga 2.7 A
Corriente pico 19.8 A
Torque mximo: 14.5 N-m
180
6.4.2
Eje
Gravedad [m/s^2]
M+m [kg]
Radio Rueda [m]
Aceleracin
[m/s^2]
0,858263061
1,031071671
1,204515515
1,378704409
1,553750025
1,72976619
1,906869182
2,085178056
2,264814975
9,81
50
0,15
radianes
0,087266389
0,104719667
0,122172944
0,139626222
0,1570795
0,174532778
0,191986056
0,209439333
0,226892611
grados
5
6
7
8
9
10
11
12
13
Torque
mnimo
6,436972954
7,73303753
9,033866361
10,34028306
11,65312519
12,97324642
14,30151886
15,63883542
16,98611231
Tabla 27. Torques requeridos por cada motor para diferentes inclinaciones.
181
Por efectos de maquinado se realizo una cua de 1.5 cm, longitud superior a la
requerida. Material, acero AISI 1020.
182
Figura 112. Diagrama de fuerzas, cortante y momentos sobre el eje en la seccin de la chumacera
D=3/4
k=1 Para eje sin hombros.
M=350 Lb*Pulg
Sn=72000 Psi
Sy=42000Psi
T=128 Lb*Pulg
Solucionando para N se obtiene un factor de seguridad de N=7,5. Con al cual
se puede asegurar que la resistencia del eje est por encima del requerimiento
terico en la parte del eje que se encuentra en contacto con la chumacera.
183
Figura 113. Diagrama de fuerzas, cortante y momentos sobre el eje en la seccin de la cua
D=3/4
k= 2 Para cuero de perfil.
M=190 Lb*Pulg
Sn=72000 Psi
Sy=42000Psi
T=128 Lb*Pulg
184
Eje de 3/4 con un acople rgido fijo en uno de sus extremos en donde entra el
eje del motor de 12 mm. El dimetro de la seccin del acople es de 11/8. Ver
figura 112.
Figura 114. Eje con acople rgido, Representacin hecha en SolidWorks y fotografa.
185
Figura 115. Representacin en Ansys del Eje Acople-Motor, Anlisis deformacin y esfuerzos
respectivamente.
186
CARACTERSTICAS
Material: Acero AISI/SAE 1045.
Dimensiones: D=3/4", L=220mm
Factor de Seguridad: 5.8
Carga Aplicada: Combinacin del peso de la
persona y estructura, torque y restricciones
hechas por las chumaceras.
6.4.3
Chumacera
www.fk-bearings.com
187
CARACTERSTICAS
Chumacera con rodamiento de bolas
Marca FK, referencia P204.
Carga mxima radial Soportada: 9880 N
Carga mxima Aplicada: 1000N.
6.4.4
188
CARACTERSTICAS
Material: Aluminio.
Marca: K9
Carga Aplicada: 50 Kg.
6.4.5
Esta pieza permite transmitir el torque desde el eje a la rueda, por medio de la
manzana, adems de servir de soporte radial. Ver figura 116, en la tabla 30
podemos observar las caractersticas de esta pieza.
189
190
Figuras 119. Representacin en ANSYS del Acople Eje-Manzana, Anlisis deformacin y esfuerzos
respectivamente.
191
CARACTERSTICAS
Material: Acero Estructural Colmena
AISI/SAE 1015.
Dimensiones: 450 x 25.4 x 25.4, espesor de
pared 2.5 mm
Factor de Seguridad: Superior a 15.
Carga Aplicada: 25 Kg.
6.4.6
192
CARACTERSTICAS
Material: Nylon
Carga Aplicada: 30 Kg.
193
6.4.7
Rueda de bicicleta
194
CARACTERSTICAS
Material: Rin de aluminio, Radios de acero,
llantas de caucho con labrado
Dimensiones: 12 Pulgadas de Dimetro
195
6.5
SILLA
6.5.1 Silla
Se selecciona una silla plstica tipo oficina. Esta se soporta sobre una
estructura tubular en aluminio de 3/4 de dimetro. Ver figura 121.
6.5.2
Posa Pies
Este elemento tiene dos funciones, servir de descanso de los pies del usuario
y por medio de l se transmite movimiento hacia adelante y atrs a travs de la
barra de mando. En la figura 121 aparece como
un tubo en forma de U
196
197
SISTEMA DE CONTROL
7.1.1 CARACTERSTICAS
10
198
Errores
en
aplicaciones
como
la
aviacin
el
de
seales
anlogas,
realizan
operaciones
realizan
MICROCONTROLADOR
199
11
http://es.wikipedia.org/wiki/Microcontrolador
200
7.2.1
Esta
placa
permite
crear
objetos
fsico
interactivos
utilizando
un
202
7.2.2
203
Figura 127. Trasformador y batera con conectores machos de 2.1 mm, alimentacin externa del Arduino.
Fuente: www.tucamon.es/contenido/tus-proyectos-6
204
205
electrnicos
como
sensores,
memorias
EEPROM,
206
7.2.2.6 Comunicaciones
EL Arduino Mega facilita en varios aspectos la comunicacin con el
computador. El ATmega1280 proporciona cuatro puertos de comunicacin va
serie UART TTL (5V). Un chip FTDI FT232RL integrado en la placa permite
esta comunicacin serie a travs del puerto USB.
El software Arduino incluye un monitor de puerto serie, que permite enviar y
recibir informacin textual de la placa Arduino, esta es una caracterstica muy
importante ya que permite visualizar los datos que leemos de algn sensor
adems podemos enviar datos al Arduino, esta funcin del Arduino permite
llevar procesos de monitoreo de los sensores y de las variables en un
programa para la realizar sistemas de control ms interactivos.
207
208
7.3
para
usuarios
no
expertos
en
programacin
de
7.3.1
Software ARDUINO
209
PROCESSING
210
12
http://www.processing.org/.
211
Funcin
Configurar
Sintaxis
Descripcin
utilizados.
o OUTPUT))
(input)
en
entrada
(output).
Generar una seal digitalWrite(pin_a_escribir,(HIGH o Ajusta el pin digital en
digital
LOW))
encendido/apagado
(high/low).(5 o 0 Volts
respectivamente).
digital.
Lee el estado del pin
Leer
una
seal analogRead(pin_a_leer)
analgica
212
Figura 130. Sistema de control de lazo cerrado bsico, con las funciones de cada bloque que lo compone.
7.3.2
Antes de poder definir cada una de las funciones que se utilizaron en el diseo
del controlador, Se describen las partes principales del cdigo fuente de
programacin del microcontrolador; Debido a que Arduino es basado en C++
debe respetarse la sintaxis bsica de este lenguaje de programacin.
7.3.2.1.
Declarar libreras
213
7.3.2.2.
ejemplo,
sintonizacin,
constantes
constantes
fsicas
de
conversin,
como
la
constantes
gravedad,
de
constantes
matemticas, etc.
Variables: las variables son tipos de datos que estarn operando dentro
del programa, esta cambiaran por medio de las operaciones que estas
realicen, la declaracin de esta variables es critica ya que el procesador
214
Pines: La tarjeta Arduino tiene una numeracin de pines para cada unos
de los mdulos con los que cuenta (modulo de entradas analgicas,
modulo de entradas/salidas digitales y modulo de salidas PWM) en la
figura 129 podemos ver la numeracin en los respectivos mdulos. Los
pines deben declararse dentro del programa para poder ser utilizados,
adems permite asignarle un nombre a cada pin de manera que pueda
identificarse que dispositivo se encuentra conectado all, de esta forma
se puede llevar un programa ms organizado y se descarta la posibilidad
de cometer errores de declaracin, que pueden ocasionar malas lecturas
o en otro caso ms crtico pueden producir daos en la electrnica del
vehculo.
7.3.2.3.
Modo de pin
El modo del pin me define el estado del pin a utilizar, adems de poder
numerar el pin e identificarlo, se debe colocar su modo de utilizacin, es decir
como entrada o salida.
215
Los pines de Arduino (Atmega 1280) por defecto son de entrada, por lo que es
necesario configurarlos
pinMode(). Se dice que los pines configurados como entradas estn en estado
de alta impedancia. Una forma de explicar esto es que los terminales de
entrada hacen demandas extremadamente pequeas en el circuito que estn
muestreando, se dice que equivale a una resistencia en serie de 100
megaohmio frente al pin.
Los pines configurados como salida (OUTPUT) con pinMode () se dice que
estn en un estado de baja impedancia. Esto significa que puede proporcionar
una cantidad sustancial de corriente a otros circuitos. Los pines del Atmega
pueden proporcionar corriente positiva o proporcionar corriente negativa de
hasta 40 mA (miliamperios) a otros dispositivos o circuitos13.
7.3.2.4.
13
http://www.arduino.cc/en/Reference/PinMode.
216
7.3.2.6.
Esta funcin es una de las dos funciones principales que componen todos los
programas en Arduino, aqu se configura todo lo relacionado con el programa:
Configurar el modo de los pines (input, output).
Configurar e inicializar la comunicacin serial.
Configurar e inicializar la comunicacin SPI.
Configurar los registros de los TIMERS para la realizacin de las
interrupciones internas.
Inicializar estados de pines (HIGH o LOW).
7.3.2.7.
Funcin P_VA
Funcin READREGISTER
217
7.3.2.9.
Funcin WRITEREGISTER
Esta funcin realiza el clculo del ngulo aplicando una tcnica llamada filtro de
balanceo, este filtro integra los dos sensores utilizados para el clculo del
ngulo, en este caso el inclinmetro y el giroscopio, primero se deben hallar las
variables en las unidades correspondientes, esta funcin requiere como
argumentos de entrada las dos variables calculadas en las funciones P_Va y
P_Vg que son los valores actuales de ngulo y velocidad angular, la figura()
muestra como se integran estos dos sensores para realizar el clculo del filtro
del ngulo, y devolviendo el ngulo exacto de la plataforma del vehculo.
218
219
Integracin
220
por tanto no deja que contine creciendo, esto permite decirle al controlador
que se ha llegado al mximo valor de salida y limita el valor de salida.
SINTAXIS
DESCRIPCIN
setup
Void setup
()
loop
Void loop ()
221
PARMETRO DE
ENTRADA
Ninguno
RETORNA
Ninguno
Ninguno
Ninguno
Incli
Float
Incli()
Ninguno
El ngulo
de
inclinacin
entre 0 y
180, tipo
float.
P_Va
float P_Va()
Ninguno
P_Vg
float
P_Vg(int
pingyro)
El ngulo
de
inclinacin
filtrado
entre -90 y
90 de tipo
float.
La
velocidad
angular
entre 0 y +100 /s.
Cal_angl
e
void
Cal_angle(fl
oat
pva,float
pvg)
ISR
ISR(TIMER2
_OVF_vect)
222
Nombre de la
variable a la cual
se le ha asignado
el nmero del pin
donde est
conectado el
giroscopio.
Necesita dos
parmetros de
entrada, ngulo
entregado por el
inclinmetro ya
filtrado (Pva), y el
valor de velocidad
angular (Pvg)
entregado por el
giroscopio.
Esta
funcin no
devuelve
ningn
valor
numrico,
solo acta
sobre los
puente H,
ya que
integra la
funcin
analogWrit
e.
Ninguno
Ninguno
7.4.
223
224
225
realizando
las
operaciones
correspondiente
estando
pendiente
del
226
227
7.5.
COMUNICACIN SPI
228
7.5.2.
Todas las lneas del bus transmiten la informacin sobre una sola direccin. La
seal sobre la lnea de reloj (SCLK) es generada por el maestro y sincroniza la
transferencia de datos.
La lnea MOSI (Master Out Slave In) transporta los datos del maestro hacia el
esclavo, entregando comandos y direcciones de registros para acceder a la
memoria del esclavo en el caso que se quiera leer un sensor.
La lnea MISO (Master In Slave Out) transporta los datos del esclavo hacia el
maestro, estos datos son la informacin que entrega el sensor, presin,
aceleracin, inclinacin etc.
En la figura 134, se muestra como pueden conectar al maestro mltiples
dispositivos, en nuestro caso solo la comunicacin se har entre el Arduino y el
inclinometro ADIS16203, el anexo D explica detalladamente este proceso.
229
230
231
8.
PRUEBAS
8.3.
MODELO DE PRUEBAS 1
232
8.4.
MODELO DE PRUEBAS 2
234
8.5.
MODELO DE PRUEBAS 3
235
8.6.
MODELO DE PRUEBAS 4
236
237
El suministro de energa de este modelo fue una fuente de 24v, por lo tanto no
se tuvo total libertad de movimiento pues dependa de la longitud de los cables
de poder y de alimentacin del arduino (USB).
8.7.
MODELO DE PRUEBAS 5
C 2: Este vehculo est montado sobre la estructura del VEAU. Compuesto por
dos motores y bateras para darle independencia de movimiento adems de la
electrnica. En la parte superior se ubic una silla de madera y sobre esta las
bateras, este peso simula el cuerpo de una persona.
Con este montaje se realizaron dos pruebas, En la primera se dejo fija una de
las ruedas y se realiz el control de equilibrio con la otra. En la segunda se
realiz el control con ambas ruedas en movimiento, adems se implemento un
algoritmo que le permiti girar al sistema, el giro del vehicul era comandado
por un potencimetro que enviaba al algoritmo de control un valor, que era
restado y sumado a la seal de control de cada uno de los motores, dando
como resultado que estas giren a diferentes velocidades, permitiendo girar. En
la figura se ve el montaje que se realizo.
La etapa de potencia usada en este modelo se baso en un arreglo de
transistores IRF4905 (PNP) [10] e IRFZ48N (NPN) [11] independientes
formando un puente H. Ver figura 142.
238
239
8.8.
MODELO DE PRUEBAS 6
240
241
Figura 147. . Fotografas de los autores del proyecto, como pasajeros en el modelo de pruebas 6
242
8.9.
MODELO FINAL
Y estos motores entregan una mayor potencia pero un menor voltaje, entonces
el consumo de corriente es muy superior que en los casos anteriores, pudiendo
llegar a picos de casi 100 A.
243
Prueba
Modelo
de
Pruebas
1
8.10.
Descripcin
Modelo de balso.
Intentar mantener
vertical un listn de
madera que pivota en
un potencimetro
corriente
Modelo
de
Pruebas
2
Montaje similar al
anterior sobre un
carrito de juguete al
que se le fijo el
potencimetro como
sensor de inclinacin
del listn.
Modelo Pndulo invertido
de
lineal. Mantener
Pruebas vertical la varilla, no
3
se realiz control de
posicin del carro.
Modelo
de
Pruebas
4
Componentes
Arduino, Integrado
L298,dos motores
pequeos con
reduccin,
potencimetro,
Algoritmo On-Off y
proporcional
Arduino, Integrado
L298, dos motores,
potencimetro,
Algoritmo PD.
Observaciones
Implementos bastante
bsicos y algoritmo
de control pobre. No
se obtuvo control
Arduino, Arreglo en
paralelo Integrado
L298, motor de
mayor potencia de
12 V sin reduccin,
potencimetro,
Algoritmo PID.
Arduino, Arreglo en
paralelo Integrado
L298, motor de
mayor potencia de
24 V con reduccin,
acelermetro y
giroscopio,
Filtro analgico,
Algoritmo PID.
Arduino, Puente H
con MOSFET dos
motores de mayor
potencia de 24 V
con reduccin,
inclinmetro y
giroscopio, Filtro
analgico, Algoritmo
PID con filtro para
los sensores.
Arduino, Puente H
con MOSFET, dos
motores de 24 V
con reduccin,
acelermetro y
giroscopio, Filtro
Cero Backlash en el
motor, mejor
algoritmo de control.
Se obtuvo control a
pesar de no tener un
segundo lazo de
control de posicin
No se logr un control
total del sistema. No
se contaba en ese
momento con un
algoritmo de control
con un filtro digital
adecuado para los
sensores.
244
Backlash en las
ruedas, mejor
Algoritmo, se obtuvo
control por pocos
segundos.
Se obtuvo un control
aceptable en las dos
pruebas que se
hicieron con este
modelo.
Se obtuvo un control
suficiente como para
soportar una persona
de 80Kg sobre el
vehculo. Por medio
de un potenciometro
Modelo
Final
Vehculo vertical de
dos disposiciones,
una de un montaje
similar al Segway y la
otra es la respectiva
del VEAU con sus
respectivos sistemas,
Sobre una placa de
aluminio.
analgico, Algoritmo
PID con filtro para
los sensores.
Arduino, Puente H
en arreglo en
paralelo de
MOSFET, dos
motores de 12 V
con reduccin
planetaria,
acelermetro y
giroscopio, Filtro
analgico, Algoritmo
PID con filtro para
los sensores.
245
9.
CONCLUSIONES
por
implemento
un
algoritmo
que
compensa
las
aceleraciones
transistores
247
248
10.
RECOMENDACIONES
biomdicos,
diseadores
industriales
personal
249
BIBLIOGRAFA
[11]International
rectifier.IRF48N
Datasheet
Version
http://www.irf.com/product-info/datasheets/data/irfz48n.pdf
febrero de 2011].
250
2.0
[en
[consulta:5
linea],
de
[12]
ST
electronics
L298N
datasheet
Version
2.0
[en
linea],
FAIRCHILD
semiconductor
4N25
datasheet
Version
1.0
[en
linea],http://www.datasheetcatalog.net/es/datasheets_pdf/4/N/2/5/4N25.shtml.
[consulta:20 de noviembre de 2010].
[14] MOTT Robert L Diseo de elementos de mquinas, cuarta edicin.
Prentice Hall.
251
ANEXOS
ANEXO A. DATASHEET INCLINOMETRO ADIS16203 DE ANALOG
DEVICES.
252
253
254
255
256
257
258
259
260
261
262
/**************************
***********************/
inicializacion
filtros
/*********************
inicializacion
comunicacion SPI *********************/
de
registros
para
263
/***************************************************************
****/
float dt=0.010;//averiguar el tiempo de interrupcion real en
segundos.
float a=0.97;
/*********************inicializacion
SPI**********************************************/
var
264
//*** Declaracion
indicacion ***/
asignacion
de
pines
para
los
LEDS
de
/************************
*******************/
SERVICE
ROUTINE
INTERUPT
ISR(TIMER2_OVF_vect){
//reseteamos el timer 2.
//la variable count la aumentamos cada vez que se genere una
interrupcion. 16000000/256/64 hara 976 desbordamientos por
segundo casi 1000
//cada vez que cuente 1000
variable second. en uno.
desbordamientos
un=1;
diez++;
if(un==1){
ADCs =1;
un=0;}
265
el
aumentara
la
if (diez == 10){
//Checks if 10 ms passed
bal = 1;
diez = 0;}
}
void setup() {
Serial.begin(9600);
266
float numg[u];
for (int n = 0 ; n<=u-1; n++ ){
numg[n] = 0;}
pinMode(reset, OUTPUT);
pinMode(pingyro,INPUT);
pinMode(pin_pot,INPUT);
pinMode(pin4,OUTPUT);
pinMode(pin5,OUTPUT);
pinMode(pin6,OUTPUT);
pinMode(pin7,OUTPUT);
pinMode(LED_verde,OUTPUT);
267
pinMode(LED_ama,OUTPUT);
digitalWrite(pin4,LOW);
digitalWrite(pin5,LOW);
digitalWrite(pin6,LOW);
digitalWrite(pin7,LOW);
digitalWrite(reset,LOW);
digitalWrite(reset,HIGH);
delay(1000);// tiempo de configuracion
};
void loop () {
if (ADCs == 1){
Pva=P_Va();
Pvg=P_Vg(pingyro);
ADCs = 0;}
if(bal == 1){
Cal_angle(Pva,Pvg);
bal = 0;}
}
/**** FUNCIONES DE USUARIO ****/
float P_Va(){
numa[k-1]=Incli();
for(int i=0;i<=k-2;i++){
numa[i]=numa[i+1];}
float s=0;
int n=0;
while(n<=k-1){
s=s+numa[n];
n++;}
268
float pro=(s/k)*0.05;
float theta=90-pro;
return theta;}
data_high = readRegister(0x06);
//realizamos una operacion & para poder utilizar solo 13 bits
del los 14 bits que envia el incliometer. 0b1111111111111
data_high = (data_high & 0x1FFF);
float tilt=data_high;
return tilt;}
/******** Filtro
*********/
del
GYROSCOPE,
calcula
el
269
vel
angular
lmotor=lbyas+motor;
rmotor=rbyas+motor;
/* saturacion! */
if (lmotor >=pwmmax) { lmotor = pwmmax; }
else if (lmotor < -pwmmax) { lmotor =-pwmmax; }
DE
270
LOS
MOTORES
else if(lmotor<0){
digitalWrite(pin5,LOW);
analogWrite(pin4,-lmotor);}
// saturacion motor derecho //
if(rmotor >=0) {
digitalWrite(pin6,LOW);
analogWrite(pin7,rmotor);}
/***************************************
************************************/
SPI
// inicializar byte
// retornamos esta
271
inByte=Spi.transfer(0x00);
digitalWrite(chipSelectPin, HIGH);
digitalWrite(chipSelectPin, LOW);
Spi.transfer(0x00);
Spi.transfer(0x00);
digitalWrite(chipSelectPin, HIGH);
return(result);}
272
//inicializamos la comunicacion.
digitalWrite(chipSelectPin, LOW);
//enviamos la direccion de registro.
Spi.transfer(dataToSend,10);
//enviamos el valor que escribiremos
Spi.transfer(thisValue,10);
digitalWrite(chipSelectPin, HIGH);
}
273
274
leer del dispositivo, y a su vez recibe un byte con la informacin que le entrega
el dispositivo Slave.
Figura 150. Secuencia de bits para el envi de datos para obtener la inclinacin.
275
Debido a problemas con los registros de salida del sensor, encontramos que el
nico registro que permite realizar la lectura de inclinacin es uno que no se
encuentra en el datasheet del sensor, aunque pedimos soporte a analog
devices sobre esto no dieron respuesta, el registro donde se encuentra la
informacin real es el 0x06.
La recepcin del byte se da cuando haya llegado la direccin de registro, segn
la figura 148, podemos ver este envi y recepcin de datos.
276
LSB=Spi.transfer (0x06);
Esto enviara la direccin el byte y a su vez guardara los bits LSB de la
informacin desde el inclinmetro en la variable return, inmediatamente se
envan 8 bits con ceros para que el sensor envi los 8 bits MSB restantes.
MSB=Spi.transfer (0x00);
Estos dos bytes darn los 14 bits del dato de inclinacin.
Luego pasar el CS de bajo a alto y luego de alto a bajo para la recepcin de
dato de inclinacin. Como el spi enva solo un byte en cada llamada de la
funcin Spi.transfer, debemos llamar la funcin dos veces y combinar cada
paquete de 8 bits en uno de 16 bits y luego con algn operador lgico &, para
poder transformar estos 16 bits a una palabra de 14 bits que nos entregara el
ngulo.
Este proceso se hace dentro de una funcin de usuario llamada readRegister
(registro a leer) que se encuentra en el cdigo fuente del controlador, ver anexo
C.
La figura 149, muestra el proceso que debe hacerse continuamente, explicado
anteriormente.
277
278
279
280
281
282
283
284
285