Tesis de Grado

Descargar como pdf o txt
Descargar como pdf o txt
Está en la página 1de 285

DISEO Y CONSTRUCCIN DE UN PROTOTIPO EXPERIMENTAL DE UN

VEHCULO ELCTRICO AUTOBALANCEADO UNIPERSONAL VEAU

Diego Alejandro Castro Zalda


Jhon Sebastin Pea Delgado

UNIVERSIDAD INDUSTRIAL DE SANTANDER


FACULTAD DE INGENIERAS FSICO MECNICAS
ESCUELA DE INGENIERA MECNICA
BUCARAMANGA
2011

DISEO Y CONSTRUCCIN DE UN PROTOTIPO EXPERIMENTAL DE UN


VEHCULO ELCTRICO AUTOBALANCEADO UNIPERSONAL VEAU

Diego Alejandro Castro Zalda


Jhon Sebastin Pea Delgado

Trabajo de grado para optar al ttulo de


Ingeniero mecnico

Director
CARLOS BORRAS PINILLA
Doctor, Ingeniero Mecnico

UNIVERSIDAD INDUSTRIAL DE SANTANDER


FACULTAD DE INGENIERAS FSICO MECNICAS
ESCUELA DE INGENIERA MECNICA
BUCARAMANGA
2011

ENTREGA DE TRABAJOS DE GRADO, TRABAJOS DE


INVESTIGACION O TESIS Y AUTORIZACIN DE SU USO A
FAVOR DE LA UIS

Yo, DIEGO ALEJANDRO CASTRO ZALDA, mayor de edad, vecino de Bucaramanga,


identificado con la Cdula de Ciudadana No. 74083963 de Sogamoso, actuando en nombre
propio, en mi calidad de autor del trabajo de grado, del trabajo de investigacin, o de la
tesis denominada(o): DISEO Y CONSTRUCCIN DE UN PROTOTIPO EXPERIMENTAL DE
UN VEHCULO ELCTRICO AUTOBALANCEADO UNIPERSONAL VEAU, hago entrega del
ejemplar respectivo y de sus anexos de ser el caso, en formato digital o electrnico (CD o DVD)
y autorizo a LA UNIVERSIDAD INDUSTRIAL DE SANTANDER, para que en los trminos
establecidos en la Ley 23 de 1982, Ley 44 de 1993, decisin Andina 351 de 1993, Decreto 460
de 1995 y dems normas generales sobre la materia, utilice y use en todas sus formas, los
derechos patrimoniales de reproduccin, comunicacin pblica, transformacin y distribucin
(alquiler, prstamo pblico e importacin) que me corresponden como creador de la obra
objeto del presente documento. PARGRAFO: La presente autorizacin se hace extensiva no
slo a las facultades y derechos de uso sobre la obra en formato o soporte material, sino
tambin para formato virtual, electrnico, digital, ptico, uso en red, Internet, extranet, intranet,
etc., y en general para cualquier formato conocido o por conocer.

EL AUTOR ESTUDIANTE, manifiesta que la obra objeto de la presente autorizacin es


original y la realiz sin violar o usurpar derechos de autor de terceros, por lo tanto la obra es de
su exclusiva autora y detenta la titularidad sobre la misma. PARGRAFO: En caso de
presentarse cualquier reclamacin o accin por parte de un tercero en cuanto a los derechos
de autor sobre la obra en cuestin, EL AUTOR / ESTUDIANTE, asumir toda la
responsabilidad, y saldr en defensa de los derechos aqu autorizados; para todos los efectos
la Universidad acta como un tercero de buena fe.

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:

DIEGO ALEJANDRO CASTRO ZALDA

ENTREGA DE TRABAJOS DE GRADO, TRABAJOS DE


INVESTIGACION O TESIS Y AUTORIZACIN DE SU USO A
FAVOR DE LA UIS
Yo, JHON SEBASTIN PEA DELGADO, mayor de edad, vecino de Bucaramanga,
identificado con la Cdula de Ciudadana No. 10986365801 de Bucaramanga , actuando en
nombre propio, en mi calidad de autor del trabajo de grado, del trabajo de investigacin, o
de la tesis denominada(o): DISEO Y CONSTRUCCIN DE UN PROTOTIPO
EXPERIMETAL DE UN VEHCULO ELECTRICO AUTOBALANCEADO UNIPERSONAL
VEAU, hago entrega del ejemplar respectivo y de sus anexos de ser el caso, en formato
digital o electrnico (CD o DVD) y autorizo a LA UNIVERSIDAD INDUSTRIAL DE
SANTANDER, para que en los trminos establecidos en la Ley 23 de 1982, Ley 44 de 1993,
decisin Andina 351 de 1993, Decreto 460 de 1995 y dems normas generales sobre la
materia, utilice y use en todas sus formas, los derechos patrimoniales de reproduccin,
comunicacin pblica, transformacin y distribucin (alquiler, prstamo pblico e importacin)
que me corresponden como creador de la obra objeto del presente documento. PARGRAFO:
La presente autorizacin se hace extensiva no slo a las facultades y derechos de uso sobre la
obra en formato o soporte material, sino tambin para formato virtual, electrnico, digital,
ptico, uso en red, Internet, extranet, intranet, etc., y en general para cualquier formato
conocido o por conocer.

EL AUTOR ESTUDIANTE, manifiesta que la obra objeto de la presente autorizacin es


original y la realiz sin violar o usurpar derechos de autor de terceros, por lo tanto la obra es de
su exclusiva autora y detenta la titularidad sobre la misma. PARGRAFO: En caso de
presentarse cualquier reclamacin o accin por parte de un tercero en cuanto a los derechos
de autor sobre la obra en cuestin, EL AUTOR / ESTUDIANTE, asumir toda la
responsabilidad, y saldr en defensa de los derechos aqu autorizados; para todos los efectos
la Universidad acta como un tercero de buena fe.

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:

JHON SEBASTIAN PEA DELGADO

A mi padre, Pedro Castro, por su apoyo y consejo oportuno.


A mi madre, Luz Mery Zalda, por su enorme confianza en m y por ser el
motor de mis proyectos, no conoce lmites cuando se trata de sus hijos.
A mis hermanos Andrs, Lina, Sara y Angelita que me contagian a diario con
su inmensa alegra y quienes sin saberlo me fuerzan a mejorar en todos los
aspectos de mi vida.

A Yolimar, por su amor desmedido y quien me acompaa da a da en la


extensa tarea de ser mejor.

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

A mi padre Pedro Pea por confiar en mis capacidades, por impulsarme a


luchar por mis sueos, ensearme a ser un gran deportista y el valor de la
perseverancia para conseguir lo que quiera y llegar a donde sea, porque
siempre fui un orgullo para l.
A mi madre Gladys Delgado, que es mi razn de vivir, por darme su apoyo
incondicional, porque nos ense cmo enfrentar los problemas de la vida e
infundio grandes valores, porque ha entregado su vida a nosotros sus hijos, y
porque s que nadie me ama ms que ella, este triunfo es por ella y para ella,
la amo con toda mi alma.
A mis hermanos Julin y Mitzi, para los que he sido un buen ejemplo, que con
su compaa han alegrado mi vida y han ayudado a superar los momentos ms
difciles, que son mi soporte en cualquier circunstancia y son mi razn de vivir,
y porque la promesa de estar juntos por toda la eternidad, me da alegra y
tranquilidad.
A Dios porque ha reflejado su gran amor en mi hermosa familia de la que estoy
orgullosamente feliz, y con sus enseanzas me ha dado herramientas para
enfrentar momentos difciles, adems ha puesto personas maravillosas junto a
m, para poder experimentar su compaa aqu en la tierra.
A mis amigos Diego Alejandro Castro que lo considero mi hermano, y ser mi
socio en todo lo que emprenda de aqu en adelante, porque pude aprender un
poco de su abundante creatividad para solucionar problemas.
A Sebastin Miranda, a Oscar Moreno, Cristian Celis, Julin Vega que aunque
estn lejos sern mi mayor patrimonio, les agradezco por alegrar mi vida.
A Martin Delgado, Carmen Delgado y mi abuelito Bernardo Delgado que me
han demostrado el verdadero amor.

Jhon Pea

AGRADECIMIENTOS

A la Universidad Industrial de Santander.


Al profesor Carlos Brras por confiar en nosotros el desarrollo de este proyecto
e incentivarnos a la investigacin y al desarrollo de temas novedosos en la UIS.
Al profesor Omar Glvez por motivarnos en el desarrollo de este proyecto.

CONTENIDO
Pg.

INTRODUCCIN .............................................................................................. 26
ANTECEDENTES ............................................................................................. 28
MARCO TERICO ........................................................................................... 37
1

FORMULACIN DEL PROBLEMA ............................................................ 66


1.1

IDENTIFICACIN DEL PROBLEMA ................................................... 66

1.2

JUSTIFICACIN PARA SOLUCIONAR EL PROBLEMA .................... 67

1.3

OBJETIVOS DEL TRABAJO DE GRADO ........................................... 67

1.3.1

Objetivo General ........................................................................... 67

1.3.2

Objetivos Especficos .................................................................... 68

MODELO ESTRUCTURAL DEL VEAU COMO SISTEMA DE DINAMICO Y

REQUERIMIENTOS DE DISEO PARA SU CONTROL ................................. 70


2.1

REQUERIMIENTOS DE DISEO ....................................................... 71

2.2

PARTE OPERATIVA ........................................................................... 72

2.2.1

La Planta Dinmica ....................................................................... 73

2.2.2

Sensores ....................................................................................... 74

2.2.3

Caractersticas de seleccin de los sensores ............................... 80

2.2.4

Seleccin del sensor de inclinacin............................................... 84

2.2.5

Seleccin del Giroscopio ............................................................. 102

2.2.6

Actuadores .................................................................................. 107

2.3

2.3.1

Controlador ................................................................................. 109

2.3.2

Pre actuador ................................................................................ 110

2.4

PARTE DE CONTROL ...................................................................... 108

PUENTE H......................................................................................... 110

2.4.1

Integrado L298N.......................................................................... 112

2.4.2

Puente H con Transistores MOSFET ......................................... 114

MODELO MATEMATICO ......................................................................... 118


3.1

MODELAMIENTO Y ESPECIFICACIONES TECNICAS DEL VEAU . 118

3.2

LINEALIZACION DEL SISTEMA ....................................................... 126

10

3.3

DESACOPLE DE SUBSISTEMAS INCLINACION-GIRO .................. 128

3.4

FUNCION DE TRANSFERENCIA ..................................................... 130

3.5

SIMULACION DEL SISTEMA DINAMICO ......................................... 132

3.6

REQUERIMIENTOS TECNICOS ....................................................... 137

CONTROL PID ......................................................................................... 139


4.1

INTRODUCCION ............................................................................... 139

4.2

EL PRINCIPIO DE REALIMENTACION ............................................ 139

4.3

CONTROL ON-OFF........................................................................... 140

4.4

CONTROL PROPORCIONAL ........................................................... 141

4.5

ERROR ESTACIONARIO .................................................................. 142

4.6

ACCIN INTEGRAL .......................................................................... 143

4.7

ACCIN DERIVATIVA....................................................................... 143

4.8

CONTROL PROPORCIONAL INTEGRAL DERIVATIVO PID ........... 144

4.9

ESTABILIZACIN DEL SISTEMA ..................................................... 145

IMPLEMENTACIN ................................................................................. 148


5.1

PARAMETROS DE CONTROL ......................................................... 148

5.1.1

Compensacin de la inclinacin con giroscopio .......................... 149

5.1.2

Parmetros del

5.1.3

Secuencia de control ................................................................... 151

5.2

IMPLEMENTACION DE LOS SENSORES........................................ 152

5.2.1

Ubicacin .................................................................................... 152

5.2.2

Filtrado y prueba de los sensores ............................................... 153

5.3

SINTONIZACIN DEL SISTEMA ...................................................... 158

5.3.1
6

............................................................. 149

Procedimiento para modificar y visualizar los valores ................. 158

DISEO ESTRUCTURAL DEL VEAU ..................................................... 160


6.1

BASTIDOR DEL VEHCULO ............................................................. 162

6.2

MECANISMO DE DESLIZAMIENTO ................................................. 165

6.2.1

Soportes ...................................................................................... 166

6.2.2

Tubos Riel ................................................................................... 168

6.2.3

Rodillos ....................................................................................... 171

6.3

SOPORTE DE LAS BATERAS ......................................................... 175

6.4

SISTEMA DE POTENCIA Y TRANSMISIN ..................................... 178

11

6.4.1

Motor DC ..................................................................................... 178

6.4.2

Eje ............................................................................................... 181

6.4.3

Chumacera .................................................................................. 187

6.4.4

Manzana de freno de disco ......................................................... 188

6.4.5

Acople entre el eje y la manzana ................................................ 189

6.4.6

Buje entre manzana y eje ............................................................ 192

6.4.7

Rueda de bicicleta ....................................................................... 194

6.5

6.5.1

Silla ............................................................................................. 196

6.5.2

Posa Pies .................................................................................... 196

6.6
7

SILLA ................................................................................................. 196

ENSAMBLE COMPLETO DEL VEAU................................................ 197

SISTEMA DE CONTROL ......................................................................... 198


7.1

SISTEMA DE CONTROL EMBEBIDO ............................................... 198

7.1.1
7.2

CARACTERSTICAS................................................................... 198

MICROCONTROLADOR ................................................................... 199

7.2.1

MICROCONTROLADOR ATMEGA 1280 DE ATMEL ................. 201

7.2.2

Caractersticas del Arduino ......................................................... 203

7.3

PROGRAMACIN DEL MICROCONTROLADOR ............................ 209

7.3.1

Software ARDUINO..................................................................... 209

7.3.2

Funciones implicadas en el control ............................................. 213

7.3.2.1.

Declarar libreras ...................................................................... 213

7.3.2.2.

Declaracin de variables: en C++ ............................................ 214

7.3.2.4.

Inicializar la comunicacin serial .............................................. 216

7.3.2.5.

Estructura del programa........................................................... 216

7.3.2.6.

Funcin (VOID) SETUP ........................................................... 217

7.3.2.7.

Funcin P_VA .......................................................................... 217

7.3.2.8.

Funcin READREGISTER ....................................................... 217

7.3.2.9.

Funcin WRITEREGISTER ..................................................... 218

7.3.2.10. Funcin P_VG.......................................................................... 218


7.3.2.11. Funcin CAL_ANGLE .............................................................. 218
7.3.2.12. Funciones de interrupcin ........................................................ 221
7.4.

CONTROL POR INTERRUPCIONES................................................ 223

12

7.4.2.
7.5.

Programacin de la interrupcin ................................................. 226

COMUNICACIN SPI........................................................................ 228

7.5.2.

Especificaciones del BUS ........................................................... 229

8. PRUEBAS ................................................................................................ 232


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

8.7.

MODELO DE PRUEBAS 5 ................................................................ 238

8.8.

MODELO DE PRUEBAS 6 ................................................................ 240

8.9.

MODELO FINAL ................................................................................ 243

8.10.

REUMEN DE LAS PRUEBAS ........................................................ 244

9. CONCLUSIONES ..................................................................................... 246


10.

RECOMENDACIONES ......................................................................... 249

BIBLIOGRAFA ............................................................................................... 250


ANEXOS

253

13

LISTA DE TABLAS
Pg.
Tabla 1. Datos Segway i2 y x2.

29

Tabla 2. Caractersticas de las versiones de Trevor Blackwell.

32

Tabla 3. Tipos de encapsulados para elementos electrnicos.

83

Tabla 4. Descripcin de los pines g-Select y de los rangos y sensibilidades


correspondientes.

90

Tabla 5. Parmetros de diseo del acelermetro.

91

Tabla 6. Descripcin de los pines del acelermetro MMA7260.

92

Tabla 7. Parmetros de diseo del acelermetro.

95

Tabla 8. Descripcin de los pines acelermetro ADXL320.

96

Tabla 9. Tabla de seleccin del acelermetro

97

Tabla 10. Caractersticas principales del ADIS16203.

99

Tabla 11. Descripcin de pines ADIS16203.

100

Tabla 12. Parmetros principales del inclinmetro.

102

Tabla 13. Caractersticas principales el giroscopio LISY300AL

104

Tabla 14. Caractersticas principales del giroscopio IDG500

106

Tabla 15. Tabla de de motores DC.

108

Tabla 16. Caractersticas principales de los transistores MOSFET utilizados.114


Tabla 17. Parmetros principales del VEAU.

120

Tabla 18. Parmetros fsicos aproximados del VEAU

130

Tabla 19. Constantes del control PD, y parmetros del sistema de control.

136

Tabla 20. Caractersticas Bastidor.

165

Tabla 21. Caractersticas Soporte Tubo Riel.

168

Tabla 22. Caractersticas Tubo Riel.

171

Tabla 23. Caractersticas del Rodillo

175

Tabla 24. Caractersticas del Soporte de Bateras.

178

Tabla 25. Caractersticas del Motor MATSUHITA.

179

Tabla 26. Caractersticas del Motor BANEBOTS.

180

Tabla 27. Torques requeridos por cada motor para diferentes inclinaciones. 181
14

Tabla 28. Caractersticas del Eje-Acople.

187

Tabla 29. Caractersticas de las Chumaceras

188

Tabla 30. Caractersticas de las manzanas.

189

Tabla 31. Caractersticas del acople eje-manzana.

192

Tabla 32. Caractersticas buje Eje-Manzana.

193

Tabla 33. Caractersticas de las Ruedas

195

Tabla 34. Funciones bsica de alto nivel del software Arduino.

212

Tabla 35 Resumen de funciones.

222

Tabla 36. Resumen de las pruebas

245

15

LISTA DE FIGURAS

Pg.
Figura 1. Segway i2 y x2 usados por Policas Colombianos.

28

Figura 2. Segway P.U.M.A.

30

Figura 3. Trevor Blackwell.

31

Figura 4. JOE. Fuente [2].

33

Figura 5. The DIY Segway.

33

Figura 6. The Two Wheel Deal.

34

Figura 7. Toyota Winglet TP..

35

Figura 8. Leonardo Moreno sobre su vehculo autobalanceado

36

Figura 9. Rotor y estator.

38

Figuras 10. Rotor tipo 1.

39

Figura 11. Rotor tipo 2. Fuente www.todorobot.com.ar

40

Figuras 12. Estator. Fuente www.todorobot.com.ar

40

Figura 13. Componentes bsicos presentes en un microcontrolador,

43

Figura 14. Arduino Duemilanove. Fuente www.arduino.cc

44

Figura 15. Arduino MEGA. Fuente www.arduino.cc.

44

Figura 16. Esquema y configuracin de un opto-acoplador 4N25.

47

Figura 17, Integrado 74LS04P, fotografa y representacin esquemtica.

47

Figura 18. Esquema de un amplificador operacional.

48

Figura 19. Representacin Fsica de un Amplificador Operacional.

49

Figura 20. Filtros Pasa-Bajos de primer y cuarto orden, respectivamente.

51

Figura 21. MOSFET de agotamiento de canal N.

52

Figura 22. MOSFET de agotamiento de canal P

53

Figura 23. MOSFET de enriquecimiento de canal N

53

Figura 24. MOSFET de enriquecimiento de canal P

54

Figura 25. Diferentes encapsulados de MOSFET de Potencia

54

Figura 26. Ubicacin de los conmutadores o transistores, formado una H

55

16

Figura 27. Flujo de la corriente a travs de los conmutadores o transistores


y el motor.

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
Figura 29. Seal de PWM a la que se le ha cambiado el ciclo de trabajo.

59

Figura 30. Control de velocidad con el PWM.

59

Figura 31.Estructura bsica de un Sistema de control en lazo cerrado.

71

Figura 32. Elementos estructurales del VEAU.

72

Figura 33. Planta dinmica de pruebas

74

Figura 34. ngulos de inclinacin que permite leer un IMU.

75

Figura 35.Descomposicin de la gravedad en los ejes X,Y.

77

Figura 36. Rotacin del vehculo respecto las ruedas.

80

Figura 37. Configuracin interna de los acelermetros de Analog Devices


de la serie ADXL250

86

Figura 38. Configuracin interna del acelermetro MMA7260 de freescale

87

Figura 39. Un caro cerca de un grupo de engranajes producidos utilizando


MEMS.

88

Figura 40. Sistema de segundo orden, base para la construccin de un


acelermetro.

88

Figura 41. Diagrama de bloques simplificado del acelermetro triaxial


MMA7260

89

Figura 42. Vista trimtrica y superior del acelermetro.

89

Figura 43. Esquema de conexin acelermetro microcontrolador

93

Figura 44. Acelermetro montado en PCB.

93

Figura 45. Diagrama de bloques simplificado del acelermetro biaxial


ADXL320.

94

Figura 46. Vista superior del acelermetro ADXL320.

95

Figura 47. Acelermetro ADXL montado en PCB de Sparkfun.

96

Figura 48. Diagrama de bloques funcional del ADIS16203.

99

Figura 49. Inclinmetro ADIS 16203 montado en PCB.

100

Figura 50. Respuesta de salida Vs orientacin.

101

Figura 51. Conexiones en PCB del ADIS16203.

102

17

Figura 52. Giroscopio LISY300Al

103

Figura 53. Diagrama de bloques giroscopio LISY300AL

103

Figura 54. Diagrama de bloques del IDG-500.

105

Figura 55. Giroscopio IDG 500 montado en PCB, vista superior.

107

Figura 56. Parte de control del sistema dinmico VEAU.

108

Figura 58. Placa de desarrollo Arduino mega, integrando un microcontrolador


atmega128 de Atmel

109

Figura 57. Configuracin de un puente H.

110

Figura 59. Esquema simplificado de funcionamiento de un puente H.

111

Figura 60. Integrado L298N, representacin en diagrama de bloques y


fotografa.

112

Figura 61. Arreglo de integrados L298N en paralelo.

113

Figura 62. Puente H con transistores MOSFET.

116

Figura 63. Puente H con transistores MOSFET en paralelo y compuertas


lgicas.

116

Figura 64. Esquema del puente H con transistores en paralelo y compuertas


lgicas. Fuente: Los autores.

117

Figura 65. Pndulo invertido

118

Figura 66. Grados de libertad del VEAU.

119

Figura 67. Diagrama de cuerpo libre del VEAU.

120

Figura 68. Diagrama de cuerpo libre ruedas izquierda y derecha.

121

Figura 69. Diagrama de cuerpo libre plataforma.

123

Figura 70. Vista superior del vehculo.

124

Figura 71. Relacin de posicin entre la plataforma y las ruedas.

125

Figura 72. Grafica del lugar de las races del sistema.

131

Figura 73. Perturbacin del sistema, aplicada por el pasajero.

133

Figura 74. Simulacin del sistema dinmico, Simulink

133

Figura 75. Bloque subsistema, del sistema dinmico VEAU

134

Figura 76. Sistema de control PD, aplicado al sistema dinmico VEAU.

135

Figura 77. Seal de entrada al sistema, como perturbacin.

135

Figura 78.inclinacion del vehculo.

136

Figura 79. Velocidad lineal del vehculo en m/s.

136

18

Figura 80. Diagrama de bloques del sistema de control de un proceso

140

Figura 81. (A) Caracterstica de un controlador On-Off ideal, (B) con Zona
muerta y (C) Histresis.

141

Figura 82. Caracterstica de un control proporcional, la entrada es el error e y la


salida es la seal de control u.

142

Figura 83. Ejemplos de comportamientos control sub amortiguado, control con


amortiguamiento crtico y control sobre amortiguado

146

Figura 84. Esquema 1 de la secuencia de control del VEAU.

152

Figura 85. Montaje para la realizacin de pruebas de los sensores.

154

Figura 86. Ubicacin de los sensores en la parte superior del vehculo de


pruebas.

155

Figura 87. Etapa de Filtrado Analgico.

155

Figura 88. Acelermetro en estado estacionario

156

Figura 89. Giroscopio en estado estacionario.

156

Figura 90. Acelermetro en movimiento oscilatorio leve

157

Figura 91. Giroscopio en movimiento oscilatorio leve

157

Figura 92. Representacin del VEAU en SolidWorks.

161

Figura 93. Bastidor junto con los componentes. Representacin hecha en


SolidWorks.

162

Figura 94. Fotografa de una de las barras.

163

Figura 95. Representacin en Ansys de las barras de la estructura base,


Anlisis deformacin y esfuerzos respectivamente.

164

Figura 96. Mecanismo de deslizamiento. Representacin hecha en


SolidWorks

165

Figuras 97. Representacin del soporte en SolidWorks y Fotografa,


respectivamente.

166

Figura 98. Representacin en Ansys de los soportes de los tubos riel, Anlisis
deformacin y esfuerzos respectivamente.

167

Figura 99. Tubo Riel del mecanismo de deslizamiento. Representacin hecha


en SolidWorks.

168

Figura 100. Fotografa Tubo Riel del mecanismo de deslizamiento.

169

19

Figura 101. Representacin en Ansys de los Tubos Riel, Anlisis


deformacin y esfuerzos respectivamente.

170

Figura 102. Rodamientos usados en los rodillos.

172

Figura 103. Rodillo. Representacin hecha en SolidWorks.

172

Figura 104. Fotografa de un conjunto de rodillos.

173

Figura 105. Representacin en Ansys de un Rodillo, Anlisis deformacin y


esfuerzos respectivamente.

174

Figura 106. Soporte Bateras junto con sus componentes ms cercanos.


Representacin hecha en SolidWorks.

175

Figura 107. Soporte Bateras. Representacin hecha en SolidWorks.

176

Figuras 108. Fotografa Soporte Bateras

176

Figura 109. Representacin en Ansys del Soporte de las Bateras, Anlisis


deformacin y esfuerzos respectivamente.

177

Figuras 110. Representacin en SolidWorks y Fotografa de uno de los


motores usados en el modelo de pruebas.

179

Figura 111. Fotografa del motor BANEBOTS, usado en el montaje final del
VEAU.

180

Figura 112. Diagrama de fuerzas, cortante y momentos sobre el eje en la


seccin de la chumacera

183

Figura 113. Diagrama de fuerzas, cortante y momentos sobre el eje en la


seccin de la cua

184

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

Figura 116. Representacin el SolidWorks y Fotografa de una de las


chumaceras.

188

Figuras 117. Representacin el SolidWorks y Fotografa de una de las


Manzanas.

189

Figuras 118. Representacin el SolidWorks y Fotografa de Acople EjeManzana

190

20

Figuras 119. Representacin en ANSYS del Acople Eje-Manzana,


Anlisis deformacin y esfuerzos respectivamente.

191

Figuras 120. Representacin el SolidWorks y Fotografa de uno de los


bujes.

193

Figura 121. Representacin el SolidWorks y Fotografa de una de las


Ruedas

194

Figura 122. Fotografas del montaje del subconjunto, transmisin de


potencia.

195

Figura 123. Fotografa de la estructura tubular que soporta la silla.

196

Figura 124. Ensamble del prototipo de vehculo autobalanceado VEAU

197

Figura 125. Estructura bsica de los microcontroladores.

200

Figura 126. Placa de desarrollo Arduino mega.

203

Figura 127. Trasformador y batera con conectores machos de 2.1 mm,


alimentacin externa del Arduino.

204

Figura 128. Esquemtico y asignacin de pines de la tarjeta Arduino.

209

Figura 129. Entorno del software Arduino. Fuente: los autores

210

Figura 130. Sistema de control de lazo cerrado bsico, con las funciones de
cada bloque que lo compone.

213

Figura 131. Caracterizacin de pines del Arduino Mega.

215

Figura 132. Filtro implementado para la obtencin del ngulo real.

219

Figura 133. Diagrama de bloques de la estructura del algoritmo de control


implementado

224

Figura 134. Control sin interrupciones.

225

Figura 135. Control con interrupciones

225

Figura 136. Esquema de comunicacin SPI mltiple.

229

Figura 137, envi de datos del microcontrolador al inclinmetro

230

Figura 138. Esquema de comunicacin entre Arduino y inclinmetro.

231

Figura 139. Modelo de pruebas 1, carrito de balso.

233

Figura 140. Fotografas del modelo de pruebas 1, ensamble total.

233

Figura 141. Fotografa del modelo de pruebas 2.

234

Figura 142. Fotografas del modelo de pruebas 3, pndulo invertido.

235

Figura 143. Fotografas del modelo de pruebas 4.

237

21

Figura 144. Fotografas del modelo de pruebas 5

239

Figura 145. Fotografas del modelo de pruebas 6.

241

Figura 146. Fotografas del modelo de pruebas 6, modulo de electrnica.

241

Figura 147. . Fotografas de los autores del proyecto, como pasajeros en el


modelo de pruebas 6

242

Figura 148. Fotografa del modelo final.

243

22

LISTA DE ANEXOS

Pg.

ANEXO A. DATASHEET INCLINOMETRO ADIS16203 DE ANALOG


DEVICES.

252

ANEXO B. DATASHEET DEL MICROCONTROLADOR ATMEGA 1280.

257

ANEXO C. CODIGO FUENTE DEL CONTROLADOR EN ARDUINO.

263

ANEXO D. COMUNICACIN SPI CON INCLINOMETRO ADIS16203.

274

ANEXO E. RESUMEN DEL DATASHEET GIROSCOPIO IDG 500.

278

ANEXO F. RESUMEN DATASHEET GIROSCOPIO LISY300AL.

283

23

RESUMEN
TITULO: DISEO Y CONSTRUCCIN DE UN PROTOTIPO EXPERIMETAL DE UN
VEHCULO ELECTRICO AUTOBALANCEADO UNIPERSONAL VEAU*.

Jhon Sebastin Pea Delgado.


Diego Alejandro Castro Zalda**
.

Palabras Clave: Autobalanceado, control, capacidades disminuidas, elctrico.

Resumen

Este Documento presenta la fase inicial del desarrollo de un Vehculo Elctrico


Autobalanceado Unipersonal, el cual tiene como caracterstica principal el uso de dos
ruedas concntricas (paralelas), una a cada lado, generando en el sistema un estado
de equilibrio inestable, el cual es controlado por la implementacin de un filtro PID, el
sistema automtico acciona los motores acoplados a cada una de las ruedas, de
acuerdo a la inclinacin que el usuario produzca sobre el vehculo.
Este vehculo es el primero de este tipo de dispositivos en el pas, por lo que fue
fundamental realizar un anlisis dinmico utilizando herramientas computacionales de
simulacin como matlab- simulink, para poder conocer el comportamiento, y variables
de estado que definen el control del vehculo, este anlisis nos permiti hacer una
seleccin de los dispositivos que componen el hardware que al integrarlo con el
software, se cre una unidad de control robusta confiable y eficiente.
El objetivo final del proyecto es crear un vehculo que tenga un impacto favorable
respecto a los problemas de trfico y contaminacin que se presentan en las grandes
ciudades, adems 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 o accidentes.

Proyecto de Grado
Facultad de Ingenieras fisicomecnicas. Escuela de Ingeniera Mecnica. Director: Carlos Brras
Pinilla.
**

24

ABSTRACT

TITLE: DESIGN AND CONSTRUCTION OF A PROTOTYPE OF A PROTOTYPE OF


A VEHICLE ELECTRIC EXPERIMENTAL SELF-BALANCING UNPERSONAL VEAU*

Jhon Sebastin Pea Delgado.


Diego Alejandro Castro Zalda**

KEY WORDS: Auto balanced, control, diminished capacity, electric.

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.

Dentro de las posibles alternativas de solucin se encuentran la aplicacin de


energa elctrica en los vehculos, dotndolos de sistemas electrnicos que
permiten utilizar la energa de manera eficiente, estas nuevas tecnologas son
impulsadas por los altos costos del petrleo. Ahora es ms comn ver en las
grandes ciudades del mundo vehculos impulsados por energa elctrica,
enfocados a tramos cortos y con reducida capacidad de carga (una o dos
personas), debido a la menor autonoma en comparacin a los vehculos que
funcionan con motores de combustin interna.

En Colombia los vehculos elctricos no han penetrado el mercado


ampliamente, debido a que un nuevo producto de gran impacto requiere apoyo
poltico y social. En Colombia el vehculo utilizado ampliamente para fcil
transporte y movilidad en tramos cortos es la motocicleta, un vehculo que
produce altos ndices de accidentalidad en el pas.

En la actualidad se est utilizando un vehculo elctrico unipersonal


penetrando el mercado del transporte en tramos cortos. Es un vehculo que
funciona en base al pndulo invertido lineal, el vehculo presenta dos ruedas
paralelas montando sobre estas una plataforma, donde el conductor va de pie,
el equilibrio es mantenido por la accin de los motores elctricos y un sistema
de control elaborado. Algunas de las ventajas de este vehculo son, ocupa el
26

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

Este tipo de vehculo tiene bsicamente un nico exponente, denominado


Segway [1], el cual fue el primer vehculo comercial de esta categora. A la
fecha, existen algunos trabajos similares entre s, orientados al control de un
vehculo inestable basados en ese primer diseo. A continuacin se describirn
brevemente estos diseos y sus caractersticas.

SEGWAY [1]

En el ao 2001, el desarrollador estadounidense Dean Kamen present un


dispositivo de transporte revolucionario para la poca, cuyo funcionamiento
est basado en el equilibrio natural de las personas: el Segway PT.

Figura 1. Segway i2 y x2 usados por Policas Colombianos.


Fuente: http://villanoticias.blogspot.com/2008/12/imagen-del-dia-las-motos-segway-hacen.html

La aparicin de este nuevo medio de transporte basado en una premisa tan


estudiada como lo es el control de un pndulo invertido, gener gran inters a
nivel mundial ya que se trataba de una solucin simple en trminos
28

constructivos, ecolgica al usar traccin elctrica, y que eventualmente poda


aportar fuertemente a la descongestin de las calles de grandes urbes al tener
el potencial de absorber la demanda de transporte en tramos cortos.
En la tabla1 se muestran las principales caractersticas de los principales
modelos comerciales que tiene Segway el i2 y x2. Ver figura 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

Tabla 1. Datos Segway i2 y x2.

Sin

embargo,

este

vehculo

no

logr

el

xito

comercial

esperado,

principalmente por el alto costo de acceder a una unidad (alrededor de


US$5.000 en EEUU). As, dichos vehculos pasaron a aplicaciones especficas,
siendo un popular reemplazo de los caddies en las canchas de golf, o en
aplicaciones de empresas, como lo es el marketing o las rondas de guardias de
seguridad. Tambin logr penetrar en un grupo de usuarios de elite cuyo nivel
de ingresos les permite acceder a este tipo de tecnologas. En el primer
semestre del 2009, Segway Inc. present un diseo experimental en conjunto
con General Motors, denominado proyecto P.U.M.A1. Este proyecto, que se
observa en la Figura 2, busca posicionar definitivamente este tipo de vehculos
como una solucin real de transporte urbano dotando al diseo original de
ciertas caractersticas que lo hacen ms amigable. En particular, este vehculo
se basa en el diseo clsico, pero permite transportar dos pasajeros sentados,
hacindolo ms parecido a un auto. El prototipo incluye ruedas extra, las que
se utilizan en las detenciones del vehculo, pero en sus desplazamientos se
sigue equilibrando dinmicamente sobre las dos ruedas centrales. Este
vehculo puede, adems, ser una gran oportunidad para los discapacitados, ya
1

www.segway.com/puma

29

que permite desplazamientos naturales para una persona (inclinndose), pero


esta vez sin el riesgo de caerse.

Figura 2. Segway P.U.M.A.


Fuente: www.segway.com/puma

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.

BALANCING SCOOTER - TREVOR BLACKWELL

Construido el 2002 por el desarrollador estadounidense Trevor Blackwell y


mejorado el ao 2005, este vehculo es la principal referencia al momento de
buscar alternativas a la versin comercial Segway, sin ser este mismo un
30

desarrollo con fines de lucro. El funcionamiento es anlogo al Segway, pero


con menores medidas de seguridad en cuanto a redundancia en el estado del
vehculo (no utiliza ms de un sensor por variable).

Figura 3. Trevor Blackwell.


Fuente:www.tlb.org/scooter.html

La primera versin realizada (Figura 3), si bien lograba un funcionamiento


ptimo, no lograba igualar al Segway, por lo que la versin 2 agreg una serie
de mejoras, en particular agrandando el tamao de las ruedas, logrando as
velocidades de casi 25 km/h. En la Tabla 2 se pueden ver las caractersticas de
ambas versiones realizadas:

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

Tabla 2. Caractersticas de las versiones de Trevor Blackwell.

JOE: A Mobile, Inverted Pendulum [2]

Este desarrollo consiste en una versin a escala radio controlada de un


vehculo autobalanceado. En este trabajo se presenta el desarrollo del modelo
matemtico del sistema y una descripcin del sistema de control implementado.
El vehculo mide 65 cm, pesa 12 kgs y es capaz de inclinarse hasta 30 grados
sin caer. Su velocidad mxima es de 1.5 m/s.

THE DIY SEGWAY [3]

Este trabajo fue desarrollado por estudiantes de secundaria de EEUU


asesorados por estudiantes del MIT (ver Figura 5). Es un poco ms pequeo
que los otros desarrollos anteriores, su estructura es una de las ms simples
existentes, basada ntegramente en aluminio para reducir el peso final.
Utiliza como unidad de procesamiento una placa de desarrollo basada en un
microprocesador PIC16F877. Lo interesante es que utiliza dos motores
relativamente pequeos (50 W aproximadamente,

337 W en pico) siendo

totalmente funcional, pero con restricciones de velocidad, masa e inclinacin


mayores a otras implementaciones.

32

Figura 4. JOE. Fuente [2].

Figura 5. The DIY Segway.


Fuente: http://web.mit.edu/first/segway

33

THE TWO WHEEL DEAL [4]

Esta versin ha sido finalizada por 4 estudiantes de la Universidad de Purdue


(ver Figura 6). En el trabajo se muestra una implementacin desde cero,
desarrollando toda la electrnica necesaria para el proyecto. Se realiza adems
un estudio detallado de factibilidad de patentar el vehculo, intentando
diferenciarlo de la competencia directa, el Segway [1].

Figura 6. The Two Wheel Deal.


Fuente: https://engineering.purdue.edu/ece477/Webs/S08-Grp12/index.html

TOYOTA WINGLET PT [5]

Esta versin es la segunda versin comercial de este tipo de vehculos (ver


Figura 7). Desarrollado por Toyota, cuenta con 3 modelos de diferentes

34

tamaos, donde destacan las versiones ms pequeas. stas se manejan


nicamente con la inclinacin de los pies. Sin embargo, no apuntan al mismo
mercado que el Segway, ya que las velocidades que alcanza son muy bajas
(del orden de los 6 km/h), lo que lo hace ms adecuado para transportarse
dentro de edificios.

Figura 7. Toyota Winglet TP..


Fuente: http://www.toyota.co.jp/en/news/08/0801_1.html

VEHCULO AUTOBALANCEADO SOBRE DOS RUEDAS [6]

Este vehculo fue desarrollado por Leonardo Felipe Moreno Bustamante como
trabajo de grado para optar al ttulo de Ingeniero Civil Electricista de la

35

Universidad de Chile. Este vehculo fue el primero en ser desarrollado en Sur


Amrica. Emplea un control proporcional derivativo.

Figura 8. Leonardo Moreno sobre su vehculo autobalanceado


Fuente: [6].

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

Figura 9. Rotor y estator.


Fuente: www.todorobot.com.ar

Dentro de stas se ubican los dems componentes como:


Escobillas y porta escobillas
Colector
Eje
Ncleo y devanado del rotor
Imn Permanente
Armazn
Tapas o campanas
Rotor
Constituye la parte mvil del motor, proporciona el torque para mover a la carga
(ver figura 10). Est formado por:
Eje: Formado por una barra de acero fresada. Imparte la rotacin al ncleo,
devanado y al colector.
Ncleo: Se localiza sobre el eje. Fabricado con capas laminadas de acero, su
funcin es proporcionar un trayecto magntico entre los polos para que el flujo
magntico del devanado circule.

38

Figuras 10. Rotor tipo 1.


Fuente www.todorobot.com.ar

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

Figura 11. Rotor tipo 2. Fuente www.todorobot.com.ar

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).

Figuras 12. Estator. Fuente www.todorobot.com.ar

40

Imn permanente: Compuesto de material ferro magntico altamente


remanente, se encuentra fijado al armazn o carcasa del estator. Su funcin es
proporcionar un campo magntico uniforme al devanado del rotor o armadura,
de modo que interacte con el campo formado por el bobinado, y se origine el
movimiento del rotor como resultado de la interaccin de estos campos.
Escobillas: Las escobillas estn fabricadas se carbn, y poseen una dureza
menor que la del colector, para evitar que ste se desgaste rpidamente. Se
encuentran albergadas por los porta escobillas. Ambos, escobillas y porta
escobillas, se encuentran en una de las tapas del estator.
La funcin de las escobillas es transmitir la tensin y corriente de la fuente de
alimentacin hacia el colector y, por consiguiente, al bobinado del rotor.
La funcin del porta escobillas es mantener a las escobillas en su posicin de
contacto firme con los segmentos del colector. Esta funcin la realiza por medio
de resortes, los cuales hacen una presin moderada sobre las escobillas contra
el colector. Esta presin debe mantenerse en un nivel intermedio pues, de ser
excesiva, la friccin desgastara tanto a las escobillas como al colector; por otro
lado, de ser mnima esta presin, se producira lo que se denomina
"chisporroteo", que es cuando aparecen chispas entre las superficies del
colector y las escobillas, debido a que no existe un buen contacto.

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

Un microcontrolador tpico posee en su interior un generador de reloj integrado,


una pequea cantidad de memoria RAM y ROM/EPROM/EEPROM. Para
hacerlos funcionar todo lo que se necesita son unos pocos programas de
control, alimentacin (tpicamente 3.3V o 5V) y un cristal de sincronizacin.

De

la

Figura

13

observamos,

que

sin

importar

el

fabricante

del

microcontrolador, siempre encontraremos que cuenta con:

Procesador o CPU (Unidad Central de Proceso).


Memoria RAM para contener los datos.
Memoria para el programa tipo ROM/EPROM/EEPROM/Flash.
Lneas de E/S para comunicarse con el exterior.
Diversos mdulos para el control de perifricos (temporizadores, puertos
serie y paralelo, CAD: Conversores Analgico/Digital, CDA: Conversores
Digital/Analgico, etc.).
Generador de impulsos de reloj que sincronizan el funcionamiento de
todo el sistema.

42

Figura 13. Componentes bsicos presentes en un microcontrolador,


Fuente: www.octoplusaz.com

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

Al ser open-hardware, tanto su diseo como su distribucin son libres. Es decir,


puede utilizarse libremente para el desarrollo de cualquier tipo de proyecto sin
haber adquirido alguna licencia. Adems en la pgina www.arduino.cc se
puede encontrar una gran cantidad de tutoriales, proyectos pasos a paso y el
respaldo de toda una comunidad a travs de foros.
En las figuras 14 y 15 se observan dos de las placas ARDUINO ms utilizadas,
el Arduino Duemilanove y el Arduino MEGA.

Figura 14. Arduino Duemilanove. Fuente www.arduino.cc

Figura 15. Arduino MEGA. Fuente www.arduino.cc.

El Arduino Mega es 100% compatible con la versin Duemilanove.


44

El Arduino MEGA utiliza un potente procesador de AVR ATMEGA1280 o AVR


ATMEGA 2560 con un amplio espacio de memoria para programar y corre a
16Mhz. Es ideal para proyecto de robtica ya que lo mejor es su elevada
cantidad de pines de entrada y salida 54, (14 con PWM) y sus 4 puertos UART
por hardware.
Caractersticas tcnicas:
- Microcontrolador: ATmega1280, 2560.
- Tensin de alimentacin: 5V.
- Tensin de entrada recomendada: 7-12V.
- Lmite de entrada: 6-20V.
- Pines digitales: 54 (14 con PWM).
- Entradas analgicas: 16.
- Corriente mxima por pin: 40 mA.
- Corriente mxima para el pin 3.3V: 50 mA.
- Memoria flash: 128 KB (4 KB usado por el bootloader).
- SRAM: 8 KB.
- EEPROM: 4 KB.
- Velocidad de reloj: 16 MHz.

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

fotoemisor y un fotorreceptor cuya conexin entre ambos es ptica. Estos


elementos se encuentran dentro de un encapsulado que por lo general es del
tipo DIP. Se suelen utilizar para aislar elctricamente a dispositivos muy
sensibles.
La figura 16, muestra un opto-acoplador 4N25 formado por un LED y un
fototransistor. La tensin de la fuente de la izquierda y la resistencia en serie
establecen una corriente en el LED emisor cuando se cierra el interruptor S1. Si
dicha corriente proporciona un nivel de luz adecuado, al incidir sobre el
fototransistor lo saturar, generando una corriente en R2. De este modo la
tensin de salida ser igual a cero con S1 cerrado y a V2 con S1 abierto.
Si la tensin de entrada vara, la cantidad de luz tambin lo har, lo que
significa que la tensin de salida cambia de acuerdo con la tensin de entrada.
De este modo el dispositivo puede acoplar una seal de entrada con el circuito
de salida, aunque hay que tener en cuenta que las curvas tensin/luz del LED
no son lineales, por lo que la seal puede distorsionarse. Se venden optoacopladores especiales para este propsito, diseados de forma que tengan un
rango en el que la seal de salida sea casi idntica a la de entrada.
La ventaja fundamental de un opto-acoplador es el aislamiento elctrico entre
los circuitos de entrada y salida. Mediante el opto-acoplador, el nico contacto
entre ambos circuitos es un haz de luz. Esto se traduce en una resistencia de
aislamiento entre los dos circuitos del orden de miles de M. Estos
aislamientos son tiles en aplicaciones de alta tensin en las que los
potenciales de los dos circuitos pueden diferir en varios miles de voltios.

46

Figura 16. Esquema y configuracin de un opto-acoplador 4N25.

INTEGRADO NEGADOR LGICO


Un negador lgico consiste en una puerta INVERSORA. Tiene una nica
entrada y una nica salida, y puede convertir una seal verdadera en falsa,
efectuando de esta manera la funcin negacin (NOT). Es decir si a la
compuerta le llega un 1 lgico (alto o voltaje) en su salida habr un 0 lgico
(bajo o 0 volts), ahora, si en la entrada de la compuerta hay 0l, en su salida se
tendr la salida de un 1.
En la Figura 17 se observa un encapsulado de una compuerta lgica negadora
muy comn, la 74LS04P y su representacin esquemtica.

Figura 17, Integrado 74LS04P, fotografa y representacin esquemtica.


Fuente: http://store.pchome.com.tw/echannel/S978890.htm

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.

Figura 18. Esquema de un amplificador operacional.

Internamente el Amplificador Operacional contiene un gran nmero de


transistores, resistores, capacitores, etc.
El terminal + es el terminal no inversor.
El terminal - es el terminal inversor
Hay varios tipos de presentacin de los amplificadores operacionales, como el
paquete dual en lnea (DIP) de 8 pines o patitas.
Para saber cul es el pin 1, se ubica una muesca entre los pines 1 y 8, siendo
el nmero 1 el pin que est a la izquierda de la muesca cuando se pone el
integrado como se muestra en la figura 19.

48

Figura 19. Representacin Fsica de un Amplificador Operacional.


Fuente: http://aliatron.com/loja/catalog/index.php

La distribucin de los terminales del Amplificador operacional en el Circuito


integrado DIP de 8 patillas es:
- pin 2: entrada inversora ( - )
- pin 3: entrada no inversora ( + )
- pin 6: salida (out)
Para alimentar un amplificador operacional se utilizan 2 fuentes de tensin:
- una positiva conectada al pin 7 y
- otra negativa conectada al pin 4

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,

comprendido entre una frecuencia de corte superior y otra inferior.


Filtro elimina banda: Tambin llamado filtro rechaza banda, atenua banda o
filtro Notch, es el que dificulta el paso de componentes frecuenciales
contenidos en un determinado rango de frecuencias, comprendido entre una
frecuencia de corte superior y otra inferior.
Filtro multibanda: Es que presenta varios rangos de frecuencias en los cuales
hay un comportamiento diferente.
Filtro variable: Es aquel que puede cambiar sus mrgenes de frecuencia.
Atendiendo a sus componentes constitutivos, naturaleza de las seales que
tratan, respuesta en frecuencia y mtodo de diseo, los filtros se clasifican en
los distintos grupos que a continuacin se indica.
Pueden ser activos o pasivos:
Filtro pasivo: Es el constituido nicamente por componentes pasivos como
condensadores, bobinas y resistencias.
Filtro activo: Es aquel que puede presentar ganancia en toda o parte de la
seal de salida respecto a la de entrada. En su implementacin se combinan
elementos activos y pasivos. Siendo frecuente el uso de amplificadores
operacionales, que permite obtener resonancia y un elevado factor Q sin el
empleo de bobinas.
Los filtros activos se componen de resistores, capacitores y dispositivos activos
como Amplificadores Operacionales o transistores.

50

En un filtro activo la salida puede ser de igual o de mayor magnitud que la


entrada, a diferencia de los pasivos.
En la figura 20 se ve la representacin de un filtro pasa bajos activos de primer
y cuarto orden usando un amplificador operacional.

Figura 20. Filtros Pasa-Bajos de primer y cuarto orden, respectivamente.


Fuente: http://es.wikipedia.org/wiki/Filtro_activo

TRANSISTORES MOSFET [7]


Un transistor MOSFET es un dispositivo controlado por voltaje, que requiere
de una pequea corriente de entrada. La velocidad de conmutacin es muy alta
siendo los tiempos de conmutacin del orden de lo nanosegundos. Los
MOSFET tienen problemas de descargas electrostticas, por lo que su manejo
requiere de cuidados especiales. Adems, es relativamente difcil protegerlos
bajo condiciones de falla por corto circuito.
Los MOSFET son de dos tipos, de agotamiento y de enriquecimiento. Un
MOSFET de agotamiento de canal N se forma en un sustrato de silicio de tipo

51

P, tal y como se muestra en la figura 21, con dos silicios N fuertemente


dopados para tener conexiones de baja resistencia. La compuerta est aislada
de canal mediante una delga capa de xido. Las tres terminales se conocen
como compuerta drenaje y fuente. Normalmente el sustrato se conecta a la
fuente. El voltaje de compuerta a fuente

, puede ser positivo o negativo. Si

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.

Figura 21. MOSFET de agotamiento de canal N.

52

Figura 22. MOSFET de agotamiento de canal P

Un MOSFET de tipo enriquecimiento de canal N, no tiene un canal fsico, tal y


como se puede observar en la figura 23. Si Vgs es positivo, un voltaje inducido
atraer los electrones del sustrato P, y los acumular en la superficie por
debajo de la capa de xido. Si Vgs es mayor que o igual a un valor conocido
como voltaje de umbral, Vt, se acumulara un nmero suficiente de electrones
para formar un canal virtual N y la corriente fluir del drenaje a la fuente. Si se
trata de un MOSFET de enriquecimiento de canal P (ver figura 24), las
polaridades de Vds, Ids y Vgs se invierten. En la figura 25 aparecen varios
transistores MOSFET de diferentes tamaos y encapsulados.

Figura 23. MOSFET de enriquecimiento de canal N

53

Figura 24. MOSFET de enriquecimiento de canal P

Figura 25. Diferentes encapsulados de MOSFET de Potencia

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

La letra H queda formada por la ubicacin de los conmutadores en el circuito.

Figura 26. Ubicacin de los conmutadores o transistores, formado una H

De acuerdo al apropiado manejo de los conmutadores, obtendremos todos los


movimientos sobre el motor. Para conectar el motor y hacerlo girar se deben
activar los conmutadores por pares opuestos en lo que respecta a lados y a
posicin (superior o inferior). Un error en la activacin que permita la conexin
de elementos superiores e inferiores de un mismo lado provocar una descarga
muy rpida y abrupta de la batera que se est utilizando o, en el peor de los
escenarios, destruir los elementos conmutadores. Como se ve en la Figura
27, para un giro seguro en uno de los dos sentidos, se debe cerrar SW1 y
SW4, observando que SW2 y SW3 permanezcan abiertas (lneas rojas). En el
caso inverso sera SW2 y SW3 cerradas, mientras que SW1 y SW4 debern
permanecer abiertas (lneas azules).

55

Figura 27. Flujo de la corriente a travs de los conmutadores o transistores y el motor.

En la actualidad, para operar motores de CC permitiendo un funcionamiento de


giro en ambos sentidos se utilizan, en la mayora de los casos, circuitos con
transistores MOSFET en lugar de los conmutadores genricos SW1 a SW4
mencionadas

con

anterioridad.

Algunos

diseadores

prefieren

utilizar

transistores de canal P para los lados superiores y de canal N para los


inferiores. La ventaja de este concepto de diseo es que las tensiones
necesarias para activar los Gates de los transistores de canal P se podrn
sacar directamente de la alimentacin utilizada para el motor. Si por el contrario
se utilizan transistores de Canal N en el lado superior de la H, la tensin
necesaria para activar los Gates deber provenir de un elevador de tensin que
funcione por encima del valor nominal de alimentacin del motor. Observando
la figura 28 se comprende mejor este concepto:

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.

Para obtener un sentido de giro determinado, los transistores MOSFET


IRFZ44N mostrados en Figura 28

debern comportarse como verdaderas

llaves conmutadoras. Tal como se desprende de la hoja de datos del transistor


empleado, para que este tipo de transistor MOSFET de canal N conduzca a
pleno, ofreciendo la menor resistencia entre Drain y Source, la tensin de Gate
respecto a Source deber ser ms positiva y el orden de los 2 a 4 Volts. Si se
asume que el transistor Q1 (en un sentido de giro) y Q3 (en el otro sentido de
giro) ofrecen la mnima resistencia, el potencial de 12 Volts que alimenta los
Drains respectivos pasar (segn el giro seleccionado) hacia el motor, tal como
muestra la figura 28.
Para que en el Source existan los 12 Volts, en el Gate se debe aplicar una
tensin entre los 14 y los 16 Volts, es decir, 2 a 4 Volts por sobre el Source. De
lo contrario, la tensin necesaria para activar el transistor a la mxima
conduccin se descontar de la tensin de alimentacin y al motor le llegarn
10 Volts o menos. De este modo, se tendr una mxima circulacin de

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

Figura 29. Seal de PWM a la que se le ha cambiado el ciclo de trabajo.


Fuente:http://laimbio08.escet.urjc.es/assets/files/docencia/EDII/ed2_prac12_pwm.pdf.

Si el periodo del PWM es suficientemente pequeo, el dispositivo que est


gobernado (por ejemplo, el motor) no notar las variaciones de la tensin y el
resultado es que el motor recibir una corriente promedio dada por el ciclo de
trabajo
En la figura 30 se muestran dos seales PWM, la primera equivale a una
tensin continua del 50% de la nominal: El motor ir a un 50% de la velocidad
mxima. Y la segunda equivale a una tensin continua del 20% de la nominal:
el motor ira a un 20% de la velocidad mxima.

Figura 30. Control de velocidad con el PWM.


Fuente:http://laimbio08.escet.urjc.es/assets/files/docencia/EDII/ed2_prac12_pwm.pdf.

59

BATERAS6
Batera, batera elctrica, acumulador elctrico o simplemente acumulador, se
le

denomina

al

dispositivo

que

almacena

energa

elctrica,

usando

procedimientos electroqumicos y que posteriormente la devuelve casi en su


totalidad; este ciclo puede repetirse por un determinado nmero de veces. Se
trata de un generador elctrico secundario; es decir, un generador que no
puede funcionar sin que se le haya suministrado electricidad previamente
mediante lo que se denomina proceso de carga.
El trmino pila, en castellano, denomina los generadores de electricidad
basados en procesos qumicos normalmente no reversibles, o acumuladores
de energa elctrica no recargables; mientras que batera se aplica
generalmente

los

dispositivos

electroqumicos

semi-reversibles,

acumuladores de energa elctrica que s se pueden recargar. Tanto pila como


batera son trminos provenientes de los primeros tiempos de la electricidad,
en los que se juntaban varios elementos o celdas: en el primer caso uno
encima de otro, "apilados", y en el segundo, adosados lateralmente, "en
batera", como se sigue haciendo actualmente, para as aumentar la magnitud
de los fenmenos elctricos y poder estudiarlos sistemticamente.
De esta explicacin se desprende que cualquiera de los dos nombres servira
para cualquier tipo, pero la costumbre ha fijado la distincin.
El trmino acumulador se aplica indistintamente a uno u otro tipo, as como a
los capacitores elctricos o a futuros mtodos de acumulacin, erigindose de
este modo como el trmino neutro capaz de englobar y describir a todos ellos.

Tipos de bateras

http://es.wikipedia.org/wiki/Bater%C3%ADa_(electricidad)

60

Segn su naturaleza interna, en el comercio se encuentran generalmente


bateras de los siguientes tipos:

Acumulador de plomo (Pb)


Est constituido por dos electrodos de plomo, de manera que, cuando el
aparato est descargado, se encuentra en forma de sulfato de plomo (II)
(PbSO4) incrustado en una matriz de plomo metlico (Pb); el electrlito es una
disolucin de cido sulfrico. Este tipo de acumulador se sigue usando an en
muchas aplicaciones, entre ellas en los automviles.
Ventajas:
Bajo coste
Fcil fabricacin
Desventajas:
No admiten sobrecargas ni descargas profundas, viendo seriamente
disminuida su vida til.
Altamente contaminantes.
Baja densidad de energa: 30 Wh/Kg
Peso

excesivo,

al

estar

compuesta

principalmente

de

plomo,

paradjicamente es ms liviana una carga de ladrillos que un


acumulador de plomo de 24 volts, por esta razn su uso en automviles
elctricos es considerado como un absurdo por los tcnicos electrnicos
con experiencia. Su uso se restringe por esta razn en aplicaciones
estacionarias como por ejemplo fuentes de alimentacin ininterrumpidas
para equipos mdicos.
Voltaje proporcionado: 12V Densidad de energa: 30 Wh/K
Batera alcalina

61

Tambin denominada de ferronquel, sus electrodos son lminas de acero en


forma de rejilla con panales rellenos de xido niqueloso (NiO), que constituyen
el electrodo positivo, y de xido ferroso (FeO), el negativo, estando formado el
electrlito por una disolucin de potasa custica (KOH). Durante la carga se
produce un proceso de oxidacin andica y otro de reduccin catdica,
transformndose el xido niqueloso en niqulico y el xido ferroso en hierro
metlico. Esta reaccin se produce en sentido inverso durante la descarga.
Se utilizan para aparatos complejos y de elevado consumo energtico. En sus
versiones de 1,5 voltios, 6 voltios y 12 voltios se emplean, por ejemplo, en
mandos a distancia (control remoto) y alarmas.
Bateras alcalinas de manganeso
Con un contenido de mercurio que ronda el 0,1% de su peso total, es una
versin mejorada de la pila anterior, en la que se ha sustituido el conductor
inico cloruro de amonio por hidrxido de potasio (de ah su nombre de
alcalina). El recipiente de la pila es de acero, y la disposicin del zinc y del
xido de manganeso (IV) (o dixido de manganeso) es la contraria, situndose
el zinc, ahora en polvo, en el centro. La cantidad de mercurio empleada para
regularizar la descarga es mayor. Esto le confiere mayor duracin, ms
constancia en el tiempo y mejor rendimiento. Por el contrario, su precio es ms
elevado. Tambin suministra una fuerza electromotriz de 1,5 V. Se utiliza en
aparatos de mayor consumo como: grabadoras porttiles, juguetes con motor,
flashes electrnicos.
Este tipo de bateras presenta algunas desventajas:
Una pila alcalina puede contaminar 175.000 litros de agua, que llega a ser el
consumo promedio de agua de toda la vida de seis personas.
Una pila comn, tambin llamada de zinc-carbono, puede contaminar 3.000
litros de agua.
Zinc, manganeso (Mn), bismuto (Bi), cobre (Cu) y plata (Ag): Son sustancias
txicas, que producen diversas alteraciones en la salud humana. El zinc,
62

manganeso y cobre son esenciales para la vida, en cantidades mnimas, y


txicos en altas dosis. El bismuto y la plata no son esenciales para la vida.
Bateras de nquel-cadmio (Ni-Cd)
Utilizan un ctodo de hidrxido de nquel y un nodo de un compuesto de
cadmio. El electrolito es de hidrxido de potasio. Esta configuracin de
materiales permite recargar la batera una vez est agotada, para su
reutilizacin. Sin embargo, su densidad de energa es de tan slo 50 Wh/kg, lo
que hace que tengan poca capacidad. Admiten sobrecargas, se pueden seguir
cargando cuando ya no admiten mas carga, aunque no la almacena. Admiten
un gran rango de temperaturas de funcionamiento.
Voltaje proporcionado: 1,2V
Densidad de energa: 50 Wh/Kg
Capacidad usual: 0.5 a 1.0 Amperios (en pilas tipo AA)
Efecto memoria: muy Alto
Bateras de nquel-hidruro metlico (Ni-MH)
Utilizan un nodo de hidrxido de nquel y un ctodo de una aleacin de hidruro
metlico. Este tipo de bateras se encuentran menos afectadas por el llamado
efecto memoria. No admiten bien el fro extremo, reduciendo drsticamente la
potencia eficaz que puede entregar. Voltaje proporcionado: 1,2V Densidad de
energa: 80 Wh/Kg Capacidad usual: 0.5 a 2.8 Amperios (en pilas tipo AA)
Efecto memoria: bajo
Bateras de iones de litio (Li-ion)
Las bateras de iones de litio (Li-ion) utilizan un nodo de grafito y un ctodo de
xido de cobalto, trifilina (LiFePO4) u xido de manganeso. Su desarrollo es
ms reciente, y permite llegar a altas densidades de capacidad. No admiten
descargas, y sufren mucho cuando stas suceden por lo que suelen llevar
acoplada circuitera adicional para conocer el estado de la batera, y evitar as

63

tanto la carga excesiva, como la descarga completa. Apenas sufren el efecto


memoria

pueden

cargarse

sin

necesidad

de

estar

descargadas

completamente, sin reduccin de su vida til. No admiten bien los cambios de


temperatura.
Voltaje proporcionado:
- A Plena carga: Entre 4.2V y 4.3V dependiendo del fabricante
- A carga nominal: Entre 3.6V y 3.7V dependiendo del fabricante
- A baja carga: Entre 2,65V y 2,75V dependiendo del fabricante (este valor no
es un lmite, se recomienda).
Densidad de energa: 115 Wh/Kg
Capacidad usual: 1.5 a 2.8 Amperios (en pilas tipo AA)
Efecto memoria: muy bajo

Bateras de polmero de litio (LiPo)


Son una variacin de las bateras de iones de litio (Li-ion). Sus caractersticas
son muy similares, pero permiten una mayor densidad de energa, as como
una tasa de descarga bastante superior. Estas bateras tienen un tamao ms
reducido respecto a las de otros componentes. Su tamao y peso las hace muy
tiles para equipos pequeos que requieran potencia y duracin, como manos
libres bluetooth.

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

Condensador de alta capacidad


Aunque los condensadores de alta capacidad no sean acumuladores
electroqumicos en sentido estricto, en la actualidad se estn consiguiendo
capacidades lo suficientemente grandes (varios faradios, F) como para que se
los pueda utilizar como bateras cuando las potencias a suministrar sean
pequeas, en relacin a su capacidad de almacenamiento de energa.
Por ello se usan como batera en algunos relojes de pulsera que recogen la
energa en forma de luz a travs de clulas fotovoltaicas, o mediante un
pequeo generador accionado mecnicamente por el muelle de la cuerda del
reloj.
Aunque funcionan como acumuladores se les suele llamar "condensadores", ya
que condensan o almacenan la corriente elctrica aunque sta flucte en el
circuito.

65

FORMULACIN DEL PROBLEMA

1.1

IDENTIFICACIN DEL PROBLEMA

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

disminuida o presentan algn grado de minusvala, una parte de la ingeniera


se ha enfocado en el desarrollo de sistemas que mejoran y facilitan su
movilidad disminuyendo la dependencia de sus semejantes.

En la actualidad se encuentra en el mercado un amplio nmero de dispositivos


de transporte que pueden cumplir con el objetivo de ayudar a movilizar
personas con capacidad disminuida calificada motora, tales como sillas de
ruedas elctricas y scooters, que bridan independencia de movimiento al
usuario. Sin embargo, estos dispositivos presentan algunas desventajas como
lo son su elevado peso y volumen, su alto costo y su reducida versatilidad para
movilizarse en espacios reducidos, adems de los estigmas sociales asociados
al uso de estos dispositivos tradicionales para el desplazamiento de personas
con capacidad motora reducida en miembros inferiores [3.2.1]. Por otro lado, no
es fcil encontrar este tipo de dispositivos de transporte para nios debido a
que su demanda es menor, en cuyos casos se debe recurrir a diseos por
encargo los cuales suelen resultar muy costosos. Razn por la cual se decidi
enfocar este proyecto a la poblacin discapacitada infantil.

66

1.2

JUSTIFICACIN PARA SOLUCIONAR EL PROBLEMA

Se propone como una solucin al problema de movilidad mencionado, un


Vehculo Elctrico Autobalanceado Unipersonal, al cual se le adiciona un
mecanismo de desbalanceo tipo timn para dar mayor sensacin de control
sobre el vehculo al usuario, a diferencia del Segway, donde la conduccin se
hace de manera intuitiva, inclinndose en la direccin en que se quiere
avanzar, dicha maniobra es difcil de ejecutar por una persona que presente
capacidad disminuida o algn grado de minusvala pues de antemano se sabe
que no cuentan con la capacidad fsica que le permite apoyar los pies en caso
de cada.

An cuando en el mercado internacional se encuentra disponible el Segway


como producto desarrollado, se prefiere realizar el diseo y la construccin de
un vehculo autobalanceado unipersonal por una razn principal: la poblacin
objetivo sobre la cual est enfocado el diseo del Segway no corresponde a
personas con algn tipo de discapacidad motora, a diferencia del VEAU, su
diseo estar enfocado hacia la satisfaccin de las personas (nios, en su fase
inicial) con capacidades disminuidas calificadas motoras o algn grado de
minusvala.

1.3
1.3.1

OBJETIVOS DEL TRABAJO DE GRADO

Objetivo General

Contribuir con la misin de la Universidad de atender y dar solucin a las


necesidades de la comunidad, en este caso, la poblacin infantil con
capacidades disminuidas, mediante el diseo, construccin de la estructura,
mecanismos necesarios para el funcionamiento y ensamble de un prototipo
experimental de un vehculo autobalanceado tipo Segway [1] , el cual, como
una silla de ruedas, cumpla con la funcin de movilizar estas personas.

67

1.3.2

Objetivos Especficos

Diseo, construccin de la estructura,

mecanismos necesarios para el

funcionamiento y ensamble de un Prototipo Experimental de un Vehculo


Autobalanceado Unipersonal VEAU, cuyo desarrollo comprender:

Diseo y construccin de la estructura del VEAU usando herramientas


computacionales de apoyo CAD y CAE, tales como SolidWorks, Cosmos
o Ansys Workbench y de simulacin como Matlab (Simulink). o LabView.
Este diseo comprender:

- Diseo y construccin del bastidor del vehculo.


- Diseo y construccin del mecanismo de deslizamiento.
- Seleccin del sistema de acople, Motor-Rueda.
- Diseo y construccin de la barra de direccin

Seleccin de los diferentes elementos que constituyen el hardware del


VEAU como son:

- Sensores (Acelermetro, encoder, giroscopio).


- Motor (Dos motores DC con encoder, [100 200 W ] cada uno).
- Ruedas.
- Controlador digital embebido.
- Bateras.
- Estructura (Silla, riel, armazn).
- Control de potencia elctrica tipo Puente H con capacidad hasta 18
Ampere y 24 Volt.
Seleccin

de

una

tarjeta

de

control

embebida,

basada

en

el

microcontrolador ATMEGA y/o similar.


Desarrollo del modelo matemtico y dinmico del VEAU y propuesta de
control PID y su sintonizacin.

68

Diseo y programacin de un algoritmo embebido de control de prueba


para evaluar el desempeo del VEAU, basado en tcnicas de control PID.

69

MODELO ESTRUCTURAL DEL VEAU COMO SISTEMA DE DINAMICO Y


REQUERIMIENTOS DE DISEO PARA SU CONTROL

El VEAU es un vehculo auto balanceado que se basa en el funcionamiento del


pndulo invertido lineal [8], por tanto el sistema dinmico que se estudi es
bsicamente una modificacin del pndulo invertido lineal, las variaciones ms
significativas son:
Vehculo auto balanceado no se encuentra sujeto a una carrera finita en
el movimiento lineal.
Necesita

de

dos

actuadores

para

poder

realizar las funciones de rotacin en su eje central, y el respectivo


control del vehculo.
En el modelo matemtico estudiado en el captulo 3, se resaltan las diferencias
entre estos dos sistemas, adems nos permite observar el comportamiento
dinmico del vehculo y estimar variables fsicas que definen los parmetros
constructivos y de diseo del vehculo.
Segn el estudio del sistema dinmico, el movimiento lineal del vehculo, es
dependiente del ngulo de inclinacin de la barra, en cambio el movimiento de
rotacin del vehculo, solo depende de la diferencia de torque entre los
motores, por tanto haciendo un control del ngulo, indirectamente se hace un
control del movimiento lineal y de rotacin del vehculo, y la perturbacin hecha
por el usuario permitir a su vez el movimiento del vehculo.
El proyecto se enfoc el diseo y construccin de un vehculo auto balanceado,
para a una persona con capacidades disminuidas. Por medio de la
investigacin de trabajos anteriormente realizados, se estimo que el control del
vehculo cuenta con un regulador PD (proporcional-derivativo), adems la
rotacin del vehculo se realiza con un control P en lazo abierto, los elementos
que corresponden al sistema de control como sensores, controlador y actuador,
se

seleccionaron

basndonos

en

tablas

70

de

seleccin

que

indican

caractersticas relevantes de las diferentes opciones, se resalta las ventajas y


desventajas de porque se utilizaron los elementos que hacen parte del VEAU.
El sistema de control VEAU se puede representar en forma bsica como un
sistema de control en lazo cerrado como el visto en la figura (). Para este caso
el sistema controla el ngulo de inclinacin del vehculo, controlando el
movimiento lineal del vehculo.

Figura 31.Estructura bsica de un Sistema de control en lazo cerrado.

2.1

REQUERIMIENTOS DE DISEO

Debido al comportamiento de este sistema dinmico, en el que el ngulo es la


principal variable a controlar, adems de otras variables que son relevantes en
el control del vehculo se requiere la medicin o estimacin en cada instante de
las siguientes variables:
Inclinacin / Velocidad de inclinacin

). Este parmetro es la

principal variable a ser controlada, ya que de ella depende directamente


el equilibrio del sistema.
Velocidad lineal ( ): velocidad de traslacin del vehculo, es una variable
no incluida en algn control como feedback, solo seria para informacin
al usuario de velocidad del vehculo.
Estado bateras. Para asegurar el correcto funcionamiento de todos los
sistemas involucrados, se debe monitorear constantemente el estado de

71

las bateras para evitar una mala alimentacin a todo el sistema de


control, evitando la prdida de control del vehculo.
Corriente en motores. De modo de proteger la etapa de potencia del
sistema, se debe monitorear la corriente circulante por sta. As, se le
puede limitar en caso de sobrepasar lmites de seguridad previamente
establecidos.
Para poder explicar de mejor manera los elementos que constituyen el sistema
dinmico y su respectivo sistema de control se divide el sistema total en su
parte operativa y de control.
2.2

PARTE OPERATIVA

La parte operativa de un sistema dinmico controlado, est compuesta por el


conjunto (estructura, sensores y actuadores), los cuales estn dispuestos en un
maquina de manera adecuada para dar soporte a estos y permiten asegurar el
perfecto funcionamiento de todo el conjunto.
En la figura () se muestra la estructura del vehculo, en la que se disponen los
sensores y actuadores, adems elementos adicionales para el funcionamiento
del vehculo segn el diseo establecido.

Figura 32. Elementos estructurales del VEAU.

72

El diseo consta de una estructura de aluminio, en las que se disponen los


sensores que componen un IMU (unidad de medicin inercial) acelermetro o
inclinmetro y giroscopio, estos permiten obtener el ngulo de inclinacin del
vehculo sin necesidad de una referencia, al combinar los dos sensores por
medio de la programacin del microcontrolador.

Esto permite hacer la retroalimentacin en el sistema de control, la fuerza


motriz esta suministrada por dos motores DC acoplados a ruedas que permiten
mediante una accin de control actuar sobre el vehculo, haciendo que el
vehculo se mantenga en posicin vertical, permitiendo el autobalanceo.

2.2.1 La Planta Dinmica

La planta dinmica del VEAU es una planta inestable, la cual necesita de


control de lazo cerrado para poder ser estabilizada, entre muchas estrategias
de control que se usan para controlar este tipo de planta se encuentran, la
lgica fuzzy, redes neuronales, algoritmos genticos, y el utilizado en la
construccin del VEAU los reguladores PID que presenta un buen
comportamiento de control gracias a la caracterstica del PID de permitir
eliminar el polo inestable de la planta, y realiza una modificacin del la planta
dinmica cambiando su naturaleza y dndole estabilidad.
Una de las caractersticas importantes del VEAU, es la distribucin de la masa
para poder ser estabilizado correctamente, debido a que la persona va sentada
y en la parte alta del vehculo, el centro de masa del vehculo se traslada a la
parte alta del vehculo, alejndose del pivote que est en el eje de las ruedas
de este modo el momento de inercia aumenta haciendo que el sistema
responda ms lento ante cambios dinmicos, esto permite al controlador ser
ms rpido que el sistema y actuar ante cambios del sistema, esta
caracterstica del sistema permite ser controlado correctamente.

73

En el vehculo de pruebas que se muestra en la figura 33 permite observar que


se le aadi peso en la parte superior para poder simular el cuerpo de la
persona (en escala) que modifica el centro de masa del vehculo, y hacer unas
pruebas del controlador mucho ms reales, de esta forma se prob el
controlador y se hicieron las pruebas inciales para poder avanzar en el
prototipo real del VEAU.

Figura 33. Planta dinmica de pruebas

2.2.2 Sensores

Son los que permiten hacer la retroalimentacin. Es uno de los elementos


fundamentales de cualquier sistema de control de lazo cerrado. En el sistema

74

de control referente al presente trabajo, los sensores permiten estimar las


distintas variables fsicas (inclinacin o rata de inclinacin del vehculo) y
envirselas al micro controlador para ejecutar alguna accin de control que ha
sido programada previamente y as realizar el control de la planta dinmica.
Para el control de la planta dinmica del VEAU, se requiere medir ngulo de
inclinacin del vehculo, se presentan una serie de factores relativos a la
naturaleza de los sensores asociados a dicha medicin que se analiza a
continuacin.
2.2.2.1 Estimacin del ngulo

Esta medicin presenta gran complejidad, en ciertas aplicaciones en donde se


necesita medir inclinacin de manera inercial, para ello se utiliza un IMU o
unidad de medicin inercial. Se utilizan en sistemas de navegacin inercial para
la medicin de variables cinemticas como la posicin, velocidad y aceleracin,
ya sea lineal o angular, adems de la orientacin de cualquier objeto en los tres
ejes coordenados sin ninguna referencia, son de gran utilidad en las
aeronaves,

barcos y misiles perseguidores entre otras aplicaciones, en la

figura () se muestran los ngulos de inclinacin que un IMU puede medir


necesarios para la aeronavegacin.

Figura 34. ngulos de inclinacin que permite leer un IMU.

75

Un IMU integra, acelermetros triaxiales, giroscopios triaxiales

y compas

electrnico, adems una computadora que pueda integrar digitalmente las


seales de los diferentes sensores de manera que pueda calcularse las
variables cinemticas necesarias (posicin, velocidad, aceleracin, tanto lineal
como angular), la calibracin de estos sensores requiere de un complejo
clculo

matemtico

para

las

mltiples

integraciones

numricas

y la

implementacin de filtros digitales para el respectivo tratamiento de la seal.

2.2.2.2 Acelermetro como sensor de inclinacin

Un acelermetro triaxial, es un sensor que detecta aceleraciones externas en


los tres ejes coordenados, referenciando el valor respecto de la gravedad.
Los acelermetros analgicos entregan un voltaje proporcional a la aceleracin
externa que se someta, este voltaje permite cuantiar la aceleracin en

Cuando se requiere utilizar un acelermetro para medir inclinacin se toma


como referencia la aceleracin de la gravedad, sabiendo que la direccin de
esta aceleracin apunta al centro de la tierra o en direccin vertical, la magnitud
de la aceleracin en direccin vertical es -1g, si se inclina el sensor se puede
apreciar que la aceleracin en el eje vertical disminuye hasta cero cuando el
eje vertical se encuentra perpendicular a la direccin de la gravedad, este
cambio permite cuantificar un valor de inclinacin utilizando las siguientes
formulas que se basan en la figura 35.

76

Figura 35.Descomposicin de la gravedad en los ejes X,Y.

Al descomponer la gravedad en los ejes X, Y se obtienen las siguientes


ecuaciones:

Es importante notar que dependiendo del cuadrante en que se encuentre el


ngulo se debe usar una u otra ecuacin, ya que solo una permitir establecer
el signo del ngulo.
Por lo tanto el acelermetro dar las componentes de la aceleracin (

). El

clculo del valor de inclinacin se hace de la siguiente manera:

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

de inclinacin, el VEAU es un vehculo en movimiento por lo que estar


expuesto a aceleraciones externas distintas a las de la gravedad.
2.2.2.3 Giroscopio electrnico como sensor de inclinacin
Un giroscopio es un sensor que permite medir velocidad angular ( ), este
sensor cuando es analgico, entrega un voltaje proporcional a la velocidad
angular y dependiendo de la resolucin del sensor se podrn detectar
velocidad angulares muy pequeas.
Sabemos que la velocidad angular es la derivada de la posicin angular, es
decir la variable que se busca estimar es:

Integrando respecto dt:

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

El problema ms claro de esta solucin es el error acumulado asociado a la


integracin numrica, que provoca que luego de transcurrido cierto tiempo de
cmputo la estimacin del ngulo tenga errores incluidos, en este tipo de
aplicaciones este error es conocido como drift, ya que el valor asociado a la
inclinacin nula se desplazar algunos grados conforme pasa el tiempo de
procesamiento.
Apreciando las ventajas y desventajas que presentan cada uno de los sensores
que integran el IMU, se debe hacer el clculo del Angulo lo ms preciso posible
para poder tener una correcta estabilizacin del vehculo, como el acelermetro
presenta una buena estimacin del ngulo a largo plazo, de manera esttica
cuando el vehculo no se mueve bruscamente, mientras el giroscopio presenta
buena estimacin del ngulo a corto plazo en donde el vehculo presenta
cambios de direccin o aceleraciones significativas, el ngulo se calcula
utilizando los dos sensores al unison, podra utilizarse la siguiente ecuacin ().

Este valor de

determina el porcentaje de creencia de cada

estimacin, y el valor se debe calcular de manera emprica observando el


comportamiento del vehculo, los IMU son ms precisos en cuanto tengan ms
giroscopios y las resoluciones y rangos de los sensores sean aun ms altas,
adems, cuando se requiere estimar el ngulo en diferentes ejes se debe tener
acelermetros y giroscopios de mltiples grados de libertad, en este caso que
se requiere calcular nicamente el ngulo rotacin de la plataforma respecto al
eje de las ruedas como lo muestra la figura 36, por lo que ser necesario la
utilizacin de un giroscopio de un grado de libertad y un acelermetro de dos
ejes.

79

Figura 36. Rotacin del vehculo respecto las ruedas.

Seleccin de sensores: como sabemos la variable principal que debemos


estimar es el ngulo, y por tanto es indispensable implementar la IMU (inertial
measurement unit), y por tanto la precisin y exactitud de esta estimacin es
dependiente de los sensores seleccionados, en la seleccin se evalan
diferentes aspectos respecto a la disponibilidad, costo, resolucin, voltaje de
alimentacin, etc. Se muestran las opciones que se evaluaron en la tabla ()
para el acelermetro y giroscopio.

2.2.3

Caractersticas de seleccin de los sensores

Voltaje

de

alimentacin

del

sensor

):

Es el

voltaje

que

continuamente debe alimentar el sensor, por tanto la salida en voltios del


sensor variara entre 0 y el Vdd, la importancia de esta caracterstica
radica que estos sensores son sensibles a sobre voltajes y a posibles
daos, la estabilidad de la lectura del sensor depende de la estabilidad
de la alimentacin de este, por tanto se hace necesario disponer de una
fuente de alimentacin precisa y estable para los sensores, o tener
alguna fuente de alimentacin mayor y regularla utilizando integrados
reguladores de voltaje, es beneficioso tener sensores que requieran el

80

mismo voltaje para poder construir un modulo de sensores con su


respectiva fuente y separarlos de la fuente de alimentacin de potencia
que involucra ruido.

Consumo de corriente (

): La corriente de consumo permite cuantificar

cuanta potencia requiere el sensor en el modo activo, esta potencia es


significativa para los mdulos o aplicaciones en donde no se dispone de
la red elctrica y es necesario la utilizacin de bateras aunque el
consumo es relativamente bajo es necesario hacer un control de este
consumo en operacin para un sensible ahorro de potencia del sistema,
aumentando la vida til de las bateras lo cual se refleja en autonoma
variable significativa en cualquier sistema de transporte y que aplica en
nuestro sistema. Los sensores disponen de modo sleep, que permiten
bajo consumo del sensor cuando la utilizacin del sensor es nula, es
mediante el microcontrolador que se programa estos modos de
utilizacin.

Bajo consumo (

): Consumo de corriente en modo sleep, es

relacionado con el consumo de potencia, entre menor sea este consumo


es ms eficiente el sistema de control en cuanto al consumo energtico.

Rango (

): Rango de medida del acelermetro, es el valor mximo de

aceleracin que puede medir el sensor, se calcula teniendo como


referencia la aceleracin de gravedad, por esto al unidad que se utiliza
es g, algunos sensores suministran mltiples rangos, el rango nos
permite evaluar la aplicacin del sensor, ya que existen sistemas en los
que se requiere medir aceleracin muy bajas, o muy altas, entre menor
el rango de medicin, mayor es la sensibilidad del sensor, de la cual se
habla en los siguientes tems.

81

Sensibilidad (

): permite obtener la relacin entre los voltios entregados

por el sensor y la variable fsica censada, en este caso particular de


medicin de aceleracin tenemos la sensibilidad dada en milivoltios por
gravedad

, la importancia radica en la integracin del sensor y el

ADC (convertidor anlogo digital) que se utilice, ya que si la resolucin


de este ltimo es muy baja no podr tener una lectura fiable del sensor,
esto se explica en el captulo de adquisicin de datos y procesamiento
de seales.

Offset (

): Este ser el valor de tensin que suministre el sensor en

ausencia de aceleracin. Como se pueden disponer de censado en


diferentes ejes esta tensin puede variar de eje en eje, la mayora de
sensores tienen un

equivalente a la mitad de la tensin de

alimentacin:

`
XY bandwidth (

): Es el ancho de banda del sensor, corresponde a la

respuesta en frecuencia del sensor, se refiere a como el sensor puede


seguir a una fuente de excitacin respecto a frecuencia, en nuestro caso
sera la frecuencia mxima a la que podemos realizar cambios de
aceleracin, y el sensor pueda notarlas, la importancia de conocer el
ancho de banda, radica en dos aspectos, primero que el sensor pueda
tener la capacidad de censar la variable fsica que requerimos en cuanto
a frecuencia, lo segundo es respecto al muestreo de datos en el
programa, la frecuencia de muestreo debe ser por lo menos el doble de
la frecuencia del ancho de banda del sensor, basndonos en el teorema
de Nyquist-Shannon que afirma: La razn de muestreo debe ser igual, o

82

mayor, al doble de su ancho de banda de la seal analgica.[referencia


que hable sobre el teorema de muestreo]
Encapsulado: Dado que los chips de silicio son muy delicados, incluso
una pequea partcula de polvo o de gota de agua puede afectar su
funcionamiento. Para combatir estos problemas, los chips se encuentran
protegidos por una carcasa o encapsulado.

Existen 2 clasificaciones generales para lo encapsulados, segn contengan


circuitos integrados o componentes discretos, encapsulados IC y encapsulados
discretos respectivamente, la tabla 3 muestra los diferentes tipos de
encapsulados para estas dos clasificaciones.

Tabla 3. Tipos de encapsulados para elementos electrnicos.

La razn de que el encapsulado sea una caracterstica de seleccin de los


sensores, es debido a que debemos realizar un mdulo de sensores donde se
deben conectar, debido a la carencia equipos para soldar circuitos integrados
superficiales de requiere de sensores montados sobre PCB, algunos
fabricantes venden el sensor y tambin el sensor en el PCB, la facilidad de
montar el sensor el modulo de sensores no inclina a seleccionar sensores que
tengan montaje en PCB.

83

Interfaz: existen dos tipos de seales digitales y anlogas, de la misma


forma los sensores suministran una seal anloga o digital, las seales
anlogas son procesadas por un ADC (convertidor anlogo digital) que
codifica la seal en bits para que pueda ser manejada por una
computadora y realizar alguna accin de control, al contrario algunos
sensores entregan la informacin de manera digital, por medio de algn
protocolo de comunicacin para permitir intercambio de informacin
entre circuitos integrados, o entre el sensor y la computadora que no
necesita de un ADC para poder manejar los datos, los protocolos de
comunicacin que pueden utilizarse definen la interfaz del sensor, los
sensores digitales son muy apreciados cuando estos se encuentran en
una ambiente de ruido electromagntico ya que no se dejan afectar, lo
contrario pasa con los sensores anlogos sensibles al ruido, incluyendo
errores en la lectura de la variable.

Costo: Debido a que el presupuesto es limitado, se selecciono la mejor


opcin en cuanto a prestaciones y soporte, sin superar el presupuesto
establecido.

Disponibilidad: la disponibilidad del sensor se refleja en el costo y el


tiempo de espera, los sensores que se encuentren a nivel nacional
reducirn los costos de importacin.

2.2.4

Seleccin del sensor de inclinacin

Antes de la seleccin del sensor de aceleracin se definen a groso modo, las


caractersticas y el funcionamiento de estos tipos de sensores electrnicos;
Podemos definir un acelermetro como un elemento de instrumentacin
mecnico o electromecnico que se utiliza para medir la aceleracin de un

84

cuerpo en movimiento. El acelermetro puede medir las componentes de la


aceleracin de un movimiento rectilneo.
Estos dispositivos determinan la aceleracin de un cuerpo midiendo la fuerza
desarrollada por una masa que se une al cuerpo en direccin al eje donde se
desea medir la aceleracin, esta medicin de fuerza se hace utilizando un
material elstico que proporciona una corriente o voltaje dependiendo
proporcional a su deformacin la interpretacin de dichas seales elctricas
nos permitir obtener informacin sobre nuestro cuerpo analizado. La fuerza se
calcula utilizando la ley de Hooke, ecuacin (1) (La deformacin de un cuerpo
es proporcional a la fuerza externa al que ha sido sometido) tambin basados
en la segunda ley de newton ecuacin (2) se obtiene la aceleracin del cuerpo:

(1)

(2)

Los acelermetros en que se ofrecen en el mercado utilizan diferentes


principios, para la obtencin de la aceleracin, es el caso de los acelermetros
de la serie ADXL250 de Analog Devices utiliza la capacitancia para medir el
desplazamiento de un sistema elstico que consiste de una barra de silicio
sujetada por cuatro hilos deformables, a la configuracin se le adiciona dos
placas metlicas paralelas para formar dos condensadores, la placa de la mitad
unida a la barra de silicio cambia la capacitancia de los condensadores
mostrado en la figura 37, este cambio de capacitancia, sabiendo que la
capacitancia est dada por:

85

Figura 37. Configuracin interna de los acelermetros de Analog Devices de la serie ADXL250

Donde K es el coeficiente del material entre las placas y d es la separacin de


las placas.
En el ADXL250, el movimiento produce un movimiento de la barra de silicio que
desplaza la placa central variando la separacin de las placas en los
condensadores, suministrado un valor de tensin proporcional a este
movimiento.
El fabricante freescale presenta su acelermetro triaxial serie MMA7260, se
encuentra entre los acelermetros capacitivos, operan con una tcnica donde
la capacitancia del elemento sensor interno vara en funcin de la aceleracin
aplicada.
En la figura 38 se representa el elemento sensor, que consiste en dos placas
conductoras paralelas (electrodos) con rea de exposicin A, y una masa m
suspendida por medio de un elemento con rigidez k. Entre la masa y los
electrodos existe una distancia base d simtrica, que se controla con precisin,
por lo que el aire que existe en el hueco entre cada electrodo y la masa ssmica
forma un capacitor mecnicamente variable.

86

Figura 38. Configuracin interna del acelermetro MMA7260 de freescale

El cambio en la distancia d corresponde a los cambios en la capacitancia.


Estos acelermetros incorporan circuitos micro-elctricos que usan puentes
capacitivos para convertir el cambio de capacitancia a una seal de voltaje til
proporcional a la aceleracin.
Analog Devices presenta la nueva tecnologa en diseo y construccin de
sensores,

MEMS

(maquinas

micro

electromecnicas),

es

tecnologa

electromecnica, micromtrica y sus productos, son construidos a escalas


relativamente ms pequeas nanomtricas. MEMS tambin se denominan
'Micro Mquinas' en Japn o tecnologa de micro sistemas (MST) en Europa,
los MEMS en general varan en tamao desde un micrmetro a un milmetro.
En este nivel de escala de tamao, las construcciones de la fsica clsica no
son siempre ciertas. Debido a la gran superficie en relacin al volumen de los
MEMS, los efectos de superficie como electrosttica y viscosidad dominan los
efectos de volumen tales como la inercia o masa trmica7.
Los MEMS se convirtieron en prcticos una vez que pudieran ser fabricados
utilizando modificacin de tecnologas de fabricacin de semiconductores,
normalmente utilizadas en electrnica. Estos incluyen moldeo, galvanoplastia,
grabado hmedo (KOH, TMAH), grabado en seco (RIE y DRIE), mecanizado
por electro descarga (EDM), y otras tecnologas capaces de fabricar
dispositivos muy pequeos, La MEMS permiti la construccin de engranajes a
7

http://es.wikipedia.org/wiki/Sistemas_microelectromec.

87

escalas muy pequeas para la construccin de micromotores, la figura 39


ilustra microengranajes construidos utilizando tecnologa MEMS.

Figura 39. Un caro cerca de un grupo de engranajes producidos utilizando MEMS.


Fuente: www.wikipedia.com/MEMS.

Los sensores que se encuentran en el mercado utilizando tecnologa MEMS


son giroscopios, acelermetros e inclinmetros. La configuracin interna de los
sensores basados en MEMS, utilizan sistemas de segundo orden, resorte masa
amortiguador para medir indirectamente la aceleracin de un cuerpo. La figura
40 muestra el sistema bsico para medicin de aceleracin.

Figura 40. Sistema de segundo orden, base para la construccin de un acelermetro.

88

2.2.4.1 Acelermetro MMA7260 FREESCALE

Una de la opciones que se tuvo en cuenta en la seleccin del acelermetro, fue


la utilizacin de un acelermetro triaxial MMA7260, del cual solo se tomaran
seales de dos ejes para estimar la inclinacin, el sensor tiene un encapsulado
tipo QFN con 16 pines, sus dimensiones son de 6[mm] x 6[mm] x 1,45[mm].La
configuracin interna bsica en diagrama de bloques se muestra en la figura
41.

Figura 41. Diagrama de bloques simplificado del acelermetro triaxial MMA7260

Cada unos de los pines en el encapsulado se muestran en la figura 42, vista


superior y trimtrica.

Figura 42. Vista trimtrica y superior del acelermetro.

89

La propiedad g-Select permite la seleccin de cuatro sensibilidades distintas.


En funcin de las entradas lgicas de los pines 1 y 2, la ganancia interna del
dispositivo variara para desplegar sensibilidades de 1.5g, 2g, 4g o 6g, tal como
se puede observar en la tabla ().Para la aplicacin se escogi un rango de 1.5
g debido a que en aplicaciones como inclinmetros, el valor mximo

de

aceleracin seria 1 gravedad, adems la sensibilidad es mucho ms alta, esto


con el fin de tener una lectura confiable respecto a la resolucin del convertidor
anlogo digital del microcontrolador utilizado.

Tabla 4. Descripcin de los pines g-Select y de los rangos y sensibilidades correspondientes.

El acelermetro de tres ejes viene provisto de un Sleep Mode un estado del


sensor de bajo consumo adecuado para sistemas que no estn conectados a la
red elctrica y necesiten de una fuente de tensin porttil como bateras. Para
activar el mode sleep, se debe dejar el pin 12 sin tensin, o un 0 lgico, con
esta configuracin las salidas no muestran medicin de aceleracin,
disminuyendo el consumo a 3

para poder activar el acelermetro deber

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

Las especificaciones para poner en correcto funcionamiento el acelermetro y


parmetros generales del sensor, se muestran en la tabla ().

Tabla 5. Parmetros de diseo del acelermetro.

Como vemos la alimentacin mxima del acelermetro es 3.6 voltios, pero es


necesario alimentar a la tensin tpica de 3.3 voltios, debido a que disponemos
de una fuente de 5 voltios, un regulador de voltaje a 3.3 voltios se dispondr en
el modulo de sensores para dicha alimentacin.

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

correspondientes a las aceleraciones en los ejes X, Y y Z, respectivamente.


Estas tres seales presentan un offset igual a 1.65V, es decir, este ser el valor
de tensin que muestren en ausencia de aceleracin. Esta informacin queda
resumida en la tabla 6.
91

Tabla 6. Descripcin de los pines del acelermetro MMA7260.

Conexin con la tarjeta de adquisicin de datos


Aunque el acelermetro dispone de filtros internamente, en la conexin con el
microcontrolador se deben integrar algunos componentes electrnicos para
poder tener una lectura de aceleracin confiable, adems se exige en la
DATASHEETS del mismo, garantizando los valores de aceleracin y lecturas
confiables de aceleracin.
Es necesario aadir un condensador de 0.1 F a VDD para desacoplar la
componente de continua de la fuente de alimentacin. Por otro lado, tambin
resulta beneficioso utilizar filtros RC a la salida de XOUT, YOUT y ZOUT para
minimizar el ruido proveniente del oscilador presente en el circuito de
capacidades conmutadas. Los valores adecuados para este filtro son 1k y
0.1F respectivamente. Las tres entradas digitales se conectaran directamente
a tres puertos digitales del microprocesador segn la configuracin que se haya
establecido. La figura 43 ilustra un esquema de conexin que se encuentra en
el datasheet del sensor.

92

Figura 43. Esquema de conexin acelermetro microcontrolador

Debido a que no se dispone de un soldador para encapsulados QFN


superficiales, se importo el acelermetro MMA7260 en PCB de la empresa
sparkfun, esta PCB incluye los filtros que se exigen, adems de los
condensadores en la alimentacin. La figura 44 ilustra el acelermetro triaxial
en PCB con los pines principales, Vdd, GND, Xaccel, Yaccel, Zaccel, g-selct1,
gselect2, sleep mode.

Figura 44. Acelermetro montado en PCB.

93

2.2.4.2 Acelermetro ADXL230

La familia ADXL de acelermetros del fabricante Analog Devices, que ofrece


una gran variedad de posibilidades para un gran nmero de aplicaciones de
diversa ndole. Se basan en la tecnologa MEMS (integrated Micro Electro
Mechanical System) para su fabricacin, garantizando as una fiabilidad del de
1FIT (1 fallo cada billn de horas en operacin). Estos sensores miden
aceleraciones estticas (gravedad) como dinmicas (vibracin, movimiento o
impactos).
Este acelermetro posee medicin de aceleracin en dos ejes su tamao es
reducido, las tensiones de alimentacin son estndar, sin embargo hay dos
caractersticas que nos desaconseja su uso,

el rango fijo y la reducida

sensibilidad, debido al convertidor anlogo digital del microcontrolador a utilizar


es relativamente reducida (10 bits), y por tanto se hace necesario utilizar
sensores que presenten sensibilidades por encima de 500 mV/g, permitiendo
lecturas confiables, otra razn es el costo del sensor que es sensiblemente
superior a los sensores que se encuentran en el mercado.

Caractersticas del acelermetro ADXL320


Analog Devices nos ofrece un sensor LFCSP con 16 pines, sus dimensiones
son de 4[mm] x 4[mm] x 1,45[mm].La configuracin interna bsica en diagrama
de bloques se muestra en la figura 45.

Figura 45. Diagrama de bloques simplificado del acelermetro biaxial ADXL320 .

94

Cada unos de los pines en el encapsulado se muestran en la figura 46, vista


superior.

Figura 46. Vista superior del acelermetro ADXL320.

El acelermetro ADXL320 presenta las siguientes desventajas respecto al


acelermetro MMA7260 analizado anteriormente, este acelermetro tiene
rango y sensibilidad nica de 5 g y 174 mV/g, debido a la baja resolucin del
ADC (convertidor anlogo digital) del microcontrolador arduino(10 bits) se
necesitan sensibilidades mayores de 500 mV/g, para tener una estimacin de
aceleracin confiable, adems este sensor no cuenta con la opcin de modo de
bajo consumo por lo que constantemente esta activo teniendo un consumo de
350

, de corriente, por ltimo el acelermetro es biaxial no teniendo mucha

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.

Tabla 7. Parmetros de diseo del acelermetro.

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.

Tabla 8. Descripcin de los pines acelermetro ADXL320.

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.

Figura 47. Acelermetro ADXL montado en PCB de Sparkfun.

96

Tabla 9. Tabla de seleccin del acelermetro

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)

El comportamiento del acelermetro, configurado para funcionar como


inclinmetro presenta buenas caractersticas de linealidad, tras estudiar esta
opcin y de acuerdo con la aplicacin en nuestro sistema que por obvias
razones estar en constante movimiento y sometido a aceleraciones variables,
la lectura de aceleracin y por tanto la de inclinacin, incluir errores debido a
estas aceleraciones dinmicas a las que est sometido, este problema que se
presenta nos permiti descartar el acelermetro como sensor de inclinacin, y
se estudi la posibilidad de utilizar un sensor de inclinacin, que tenga interfaz
digital, descartando el problema de ruido electromagntico producido por los
motores y dems dispositivos electrnicos que componen el sistema de control.

97

2.2.4.3 Inclinmetro ADIS16203

Este inclinmetro de Analog Devices basado en tecnologa MEMS, incluye


dentro de este, acelermetros configurados de manera que entreguen una
medicin de inclinacin correcta, sin necesidad de clculos trigonomtricos,
utilizados para adaptar el acelermetro como un inclinmetro, el inclinmetro
presenta interfaz digital, descartando algn error que pueda ser producido por
ruido electromagntico, todas estas caractersticas hacen de este sensor un
excelente elemento de instrumentacin.
Otra de las ventajas del inclinmetro es la interfaz digital SPI, para la
comunicacin con el microcontrolador, esta interfaz es altamente programable.
La medicin de inclinacin puede entregarse en distintos formatos (0-360, o
bien +/-180), configurar el ngulo 0 en distintas posiciones, determinar
tiempos de muestreo, generar alarmas para distintas condiciones, integra
tambin un sensor de temperatura y conversores digital-anlogo, entre otras
caractersticas, todas las caractersticas anteriormente nombradas son de gran
utilidad para diferentes aplicaciones, en nuestro se utilizar nicamente la
medicin del ngulo, para lo cual se debe ajustar el sensor en trminos de
calibrar el cero y el tiempo de muestreo.

Caractersticas del inclinmetro ADIS16203.


Este sensor de inclinacin posee mltiples caractersticas integradas, de las
cuales estn medicin de temperatura, medicin de inclinacin, adems es
altamente programable. El diagrama de bloques del inclinmetro se muestra en
la figura ().

98

Figura 48. Diagrama de bloques funcional del ADIS16203.

Este sensor posee interfaz digital, por lo tanto la seal de inclinacin va


codificada en una palabra de 14 bits (0-16384), estos bits son comunicados por
medio de SPI, que luego son transformados a grados sabiendo que el rango
mximo de medida es 360.

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

Tabla 10. Caractersticas principales del ADIS16203.

La tabla 10 presenta las caractersticas principales del inclinmetro ADIS1603 y


la figura 49, ilustra el inclinmetro montado sobre la placa PCB de la que
dispone Analog Devices para este modelo de inclinmetro.

99

Figura 49. Inclinmetro ADIS 16203 montado en PCB.

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.

Tabla 11. Descripcin de pines ADIS16203.

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.

Figura 50. Respuesta de salida Vs orientacin.

El inclinmetro posee un encapsulado LGA, el cual no es posible ser soldado


en las instalaciones por lo que se debe importar el ADIS16203 en PCB, aunque
el precio tuvo un incremento notable respecto al encapsulado nos ahorramos la
tediosa tarea de soldar este integrado, el PCB conecta las salida de sensor a
los pines correspondientes los cuales permiten realizar las conexiones
fcilmente.

101

Figura 51. Conexiones en PCB del ADIS16203.

En la tabla 12. Se dan los parmetros principales de este sensor.

Tabla 12. Parmetros principales del inclinmetro.

2.2.5

Seleccin del Giroscopio

El giroscopio es un sensor que permite estimar la velocidad angular respecto a


los ejes para los que haya sido diseado, en nuestro diseo se incluyo la
utilizacin de este sensor, para integrar el IMU, sistema que permitir calcular
la inclinacin del vehculo en todo momento. La seleccin de estas dos
alternativas que se estudiaron tiene en cuenta parmetros de consumo,
alimentacin disponibilidad, sensibilidad y rango.

102

2.2.5.1 Giroscopio LISY 300AL

Un modelo de ST Electronics, referencia lisy300Al, montado en PCB, se


muestra en la figura 52.

Figura 52. Giroscopio LISY300Al

El giroscopio LISY300AL es un tipo sensor de bajo consumo de energa, de un


solo eje. Incluye un elemento de deteccin y un IC(circuito integrado) capaz de
proporcionar una medida de velocidad angular, a travs de una tensin de
salida anloga, el sensor es capaz de detectar la velocidad angular, se ha
fabricado con un dedicado proceso de micro mecanizado (MEMS)desarrollados
por ST para producir sensores inerciales y actuadores en obleas de silicio, el
diagrama de bloques del LISY300AL se ilustra en la figura 53.

Figura 53. Diagrama de bloques giroscopio LISY300AL

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

Tabla 13. Caractersticas principales el giroscopio LISY300AL

2.2.5.2 Giroscopio IDG 500 de invensense

El IDG-500 es un girscopo de tecnologa MEMS suministra velocidad angular


en dos ejes, este est diseado especficamente para el procesamiento de
movimiento complejo.
Ofrece mejoras de rendimiento significativas, el IDG-500 ofrece 500 / s a gran
escala, y 2mV / / s de sensibilidad, en un tamao 4x5x1.2mm.
Con la incorporacin de la tecnologa patentada funcin Auto Cero, para reducir
al mnimo la deriva sesgo respecto a la temperatura, el IDG-500 ofrece un
rendimiento sin precedentes.

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.

Figura 54. Diagrama de bloques del IDG-500.

La tabla 14. Resume las caractersticas principales de este sensor biaxial,


adems se comparan las dos alternativas, donde se observan las diferencias
claras, para mayor informacin sobre giroscopio IDG 500, se dispone el
datasheet en el anexo E.

105

Tabla 14. Caractersticas principales del giroscopio IDG500


CARACTERSTICA

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

Luego de el anlisis de las diferencias hecho a los dos sensores, se puede


concluir que para la aplicacin en este proyecto, sugerimos la utilizacin de el
giroscopio IDG 500 de invensense, debido a su alta sensibilidad (tres veces la
del LISY300AL), aunque a un rango bajo (110 /s) no teniendo mucha
relevancia en nuestra aplicacin, esta alta sensibilidad permite optimizar la
adquisicin de datos, debido a que la resolucin de ADC del microcontrolador
utilizado es relativamente baja (10bits). El consumo de corriente es alto, pero
esto no tendr mayores implicaciones, el ancho de banda es otra ventaja de
este sensor, 31 KHz para la aplicacin es bastante bueno, aunque el costo es
alto (39.95 $US), comparado con el LISY300AL (19.95 $US), podemos tener
mejor rendimiento en el sistema de control utilizando este sensor, que muestra
significativas ventajas con las opciones que se ofrecen en el mercado.
Debido a que el encapsulado del IDG 500, no es posible ser solado al PCB en
el laboratorio, se decidi importar el IDG 500 en PCB que ofrece sparkfun, la
figura 55. ilustra el giroscopio IDG 500 montado en PCB.

106

Figura 55. Giroscopio IDG 500 montado en PCB, vista superior.

2.2.6

Actuadores

En esta parte se considera el anlisis y la seleccin de los motores ya que es


uno de elementos fundamentales del modelo estructural del sistema dinmico,
se opto por utilizar motores de corriente continua. Este tipo de motor es muy
poco utilizado en el mercado y debido a ello la disponibilidad en el mercado
nacional es muy reducida, por lo que hace necesario importarlos.
En muchas aplicaciones de este tipo [2,3,6], se seleccionaron motores de
potencias y torques muy similares, en la tabla 15 se muestran cuales motores
podran ser una alternativa para el proyecto VEAU, ya que cumple con los
requerimientos de velocidad, torque y potencia que se exige en esta aplicacin.
La eleccin del motor permiti determinar parmetros generales de diseo en
trminos estructurales, como son el peso y tamao, en trminos de la
electrnica de potencia, como son la corriente pico y voltaje de alimentacin, a
el elemento que compone la electrnica de potencia se le llama el pre actuador,
uno de las elementos principales de este proyecto ya que este elemento es la
interface entre el controlador y el actuador.

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

Tabla 15. Tabla de de motores DC.

2.3

PARTE DE CONTROL

La parte de control en el sistema dinmico VEAU est constituida por el pre


actuador y el controlador, adicionalmente las comunicaciones entre los distintos
dispositivos que componen la planta dinmica del VEAU, en la figura 56 se
seala la parte de control.

Figura 56. Parte de control del sistema dinmico VEAU.

108

2.3.1 Controlador

Se utilizo una tarjeta de desarrollo llamada Arduino mega se ilustra en la figura


58, esta tarjeta incluye todos los dispositivos electrnicos necesarios para
integrar un microcontrolador atmega1280 del fabricante Atmel, en la cual se
diseo un controlador embebido para la planta dinmica del VEAU por medio
de la programacin en el software de alto nivel Arduino, basado en C++.

Figura 58. Placa de desarrollo Arduino mega, integrando un microcontrolador atmega128 de Atmel

Caractersticas Principales de la tarjeta ARDUINO mega


Clock de 16 MHz
Memoria 128 KB (flash)
Memoria 16 KB (RAM)
Rango alimentacin de la tarjeta 5-9 Volts
16 pines de entradas analgicas con un ADC de 10 bits
Rango de temperatura-40C a +105C
11 pines de PWM de 8 bits.
4 channel de comunicacin (SPI/UART).
Comunicacin con el ordenador mediante puertos USB o COM.

109

2.3.2

Pre actuador

Para el control de los motores se requiri implementar dispositivo llamado


puente H, capaz de controlar la direccin y velocidad de los actuadores,
dependiendo de las seales de control que entregue el controlador. Este
dispositivo acopla la parte control con la parte de potencia de nuestro sistema,
y su importancia es clara en el funcionamiento del vehculo, una configuracin
bsica de un puente H se observa en la figura 57.

Figura 57. Configuracin de un puente H.

El dispositivo puente H basado en transistores que soporten los voltajes y


corrientes necesarios para alimentar correctamente el motor.
La alimentacin ser a 24 V, en base a 2 bateras de 12 V. El control del voltaje
entregado al motor ser mediante seales PWM que excitan el semiconductor,
permitiendo un control de velocidad y direccin.

2.4

PUENTE H

110

El control de velocidad de los motores se realiza por medio de regulacin de


voltaje promedio que llegue al motor, esta regulacin se realiza por medio de la
utilizacin de un transistor que no es ms que una vlvula que regula corriente
al motor, regulando el voltaje entre las terminales del motor.
Para el control de la direccin del motor se configuran el encendido de los
MOSFETS de manera secuencial como se muestra en la figura 59.

Figura 59. Esquema simplificado de funcionamiento de un puente H.

El interruptor I1A como el I1B se encuentra encendidos, lo que permite que la


corriente fluya a travs de ellos y de la armadura del motor. Para cambiar el
sentido de giro, basta apagar I1A y I1B, y encender I2A y I2B.
Para regular la tensin suministrada al motor, se vara el ciclo de trabajo del
PWM que se entrega al transistor, haciendo una analoga sera regular la
apertura de una vlvula que regula flujo, entre mayor sea el ciclo de trabajo
mayor apertura de la vlvula.
Para las diferentes etapas del proyecto se realizaron diferentes arreglos de
puentes H. Conforme iba aumentando el tamao del montaje, as mismo lo
hacan los motores y con estos la capacidad del puente H tambin debi

111

aumentar. A continuacin se explica brevemente cada uno de los arreglos que


se implementaron.

2.4.1

Integrado L298N

Primer arreglo: Para manejo de corrientes entre 0 y 1.5 Amp, se us el


integrado L298N [11]. Este integrado est compuesto por una serie de
transistores BJT que forman dos puentes H con una capacidad mxima de
manejo de corriente de 2 A continuos y hasta 3 A, en picos que no se repitan
continuamente. En la figura 60 se observa el equivalente en un diagrama de
bloques del este integrado y una fotografa del mismo.

Figura 60. Integrado L298N, representacin en diagrama de bloques y fotografa.

Para su funcionamiento este integrado requiere de una entrada de potencia de


hasta 46 Volt, una entrada que alimenta el integrado que va entre 5 y 7 Volt y
dos entradas de control. Si una entrada recibe la seal en PWM la otra debe
estar en cero para que el motor gire en un sentido. Para girar en sentido
contrario, se deben invertir las entradas, es decir, la que reciba el PWM ahora
est en cero y la que est en cero ahora recibe PWM.
Para manejar corrientes mayores a dos ampere, los dos arreglos internos de
este integrado se pueden conectar en paralelo, as como tambin se puede
realizar un montaje en paralelo de varios integrados. El comportamiento en
112

paralelo de este tipo de integrado no es proporcional al nmero de integrados


que se usen, es decir, si se conectan en paralelo cuatro puentes H (cada uno
soporta 2 A) no quiere decir que el Puente H resultante vaya a soportar 8 A,
puesto que los transistores BJT no permiten la distribucin exacta de la carga
entre los transistores que se encuentren en paralelo, es decir, se recargan unos
ms que otros hasta quemarse.
Para manejar corrientes entre 2 y 4 ampere continuos y 13 ampere en pico se
realiz el arreglo que se ve en la figura 61, con 6 integrados L298N. En esta
figura se puede observar que en la parte trasera de los integrados hay una
placa disipadora de calor refrigerada por dos ventiladores que ayudan al
sistema a mantener una temperatura adecuada.

Figura 61. Arreglo de integrados L298N en paralelo.

113

2.4.2 Puente H con Transistores MOSFET

Para manejo de corrientes atas se realizaron dos montajes usando transistores


MOSFET. En el primer montaje se implement una estructura de puente H
como se muestra en la figura 62. Este montaje usa un solo transistor en donde
va cada switch. Mientras que para el segundo montaje y para garantizar una
mayor capacidad de manejo de corriente se usaron transistores en paralelo.
Ver figura 63.
Para la implementacin estos puentes H utilizaron MOSFET NPN, IRF48N [11]
en la parte superior del arreglo, mientras que en la inferior se usaron PNP,
IRF4905 [10]. Las caractersticas principales se muestran en la Tabla 16.

Modelo
(mximo)

IRF48N

IRF4901

55 V

55 V

0.016

0.02

64 A

74 A

Tabla 16. Caractersticas principales de los transistores MOSFET utilizados.

El puente H mostrado en la figura 62 est compuesto por dos transistores


IRFZ48N y dos IRF4905. Funciona con 24 Volt. Tiene incorporado un arreglo
de compuertas lgicas que permiten que este use solo dos entradas de control
de tal forma que mientras una recibe la seal PWM la otra debe estar en cero
para que el motor gire en un sentido y al contrario para que el motor gire en el
otro sentido. Debe cuidarse de que en ningn momento queden ambas
entradas en ALTO (5 Volt), pues esto implica un corto en los transistores, lo
que los daa inmediatamente.

114

Para su funcionamiento requiere adems de la entrada de potencia (24 Volt)


una entrada de voltaje de alimentacin (5 Volt) de los integrados lgicos,
ambas deben llevar tierras independientes.
Las entradas de este puente H estn aisladas por medio de un opto-acoplador
[13], de tal forma que en caso se corto o dao en los transistores no dae el
microcontrolador.
Para el manejo de corrientes ms altas que en el caso anterior fue necesario el
desarrollo de un puente H con transistores en Paralelo (ver figura 63), lo cual
casi duplica la capacidad del puente H anterior.
La corriente mxima que maneja la etapa de potencia implementada en este
proyecto es de 19.8 A en pico y bajo ciertas condiciones se puede alcanzar el
estado de Stall current (133A). Este arreglo asegura que la electrnica de
potencia este por encima de los requerimientos de los motores, el cual puede
soportar hasta 148 A bajo apropiadas condiciones de disipacin de calor, razn
por la cual se fijo un ventilador sobre los transistores.
Para su funcionamiento este puente H requiere de una entrada de potencia (12
Volt), una entrada de alimentacin de la parte lgica (5 Volt), ambas con tierras
independientes y dos seales de control.
Por medio de un circuito hecho con compuertas lgicas, el funcionamiento de
las seales de control para este puente H es diferente a las usadas en los
casos anteriores. Requiere de dos seales A y B. Si A es ALTO (5 Volt) el
motor gira hacia un sentido, si es bajo (0 Volts) el motor gira hacia el otro lado.
B recibe la seal en PWM. De esta forma se evita que en algn momento
ambas ramas del puente H queden en ALTO, evitando as un corto en los
transistores.
En la figura 64 se observa el esquema de este puente H.

115

Figura 62. Puente H con transistores MOSFET.

Figura 63. Puente H con transistores MOSFET en paralelo y compuertas lgicas.

116

Figura 64. Esquema del puente H con transistores en paralelo y compuertas lgicas. Fuente: Los
autores.

117

3.1

MODELO MATEMATICO

MODELAMIENTO Y ESPECIFICACIONES TECNICAS DEL VEAU

Antes de implementar cualquier mtodo de control para el sistema dinmico


que se implemento, se desarrollo un modelo matemtico para estimar el
comportamiento del sistema, y de esta forma poder hallar los requerimientos
tcnicos de control, entr los cuales se encuentran; la energa que debemos
suministrar, variables de estado, materiales a utilizar, perturbaciones, etc.
El sistema que se desarroll est basado en el pndulo invertido que se
muestra en la figura 65, este es un sistema dinmicamente inestable de dos
grados de libertad (2 DOF), inclinacin ( ) y desplazamiento (X).

Figura 65. Pndulo invertido


Fuente: http://www.ib.cnea.gov.ar

El sistema desarrollado en este proyecto es un sistema de tres grados de


libertad (3 DOF), inclinacin, rotacin y desplazamiento. La Figura 66 muestra,
la rotacin respecto al eje Z llamado picth angle (

, rotacin respecto al

eje Y llamado yaw angle ( , y el desplazamiento en el eje X (

. 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

que pueda indirectamente controlar las otras, as se reduce la complejidad de


control de sistemas mltiples.

Figura 66. Grados de libertad del VEAU.


Fuente: Grasser Felix, Darrigo Aldo, Colombi Silvio, Rufer Alfred; JOE: A Mobile Inverted Pendulum .

El modelo matemtico se baso en trabajos anteriores, se resumen en el


captulo de antecedentes, en los que se dan pautas para el diseo y
construccin de un vehculo auto balanceado, el alcance de estos trabajos han
sido el desarrollo e implementacin de un vehculo auto balanceado8.
Para el desarrollo del modelo matemtico se simplifico el sistema en cuanto a
su estructura y parmetros dimensionales, a una barra horizontal con dos
ruedas en sus extremos, unidos a su vez con una barra vertical en su centro,
esta simplificacin permite obtener un vehculo ms fcil de analizar. Se
muestra en la figura 67.

Diseo e implementacin de un vehculo auto balanceado sobre dos ruedas; Leonardo Felipe
Moreno Bustamante.

119

Figura 67. Diagrama de cuerpo libre del VEAU.

Para el vehculo se seleccionaron las siguientes variables y parmetros que se


integran en la tabla 17, que definen el comportamiento dinmico del vehculo.
NOMBRE

TIPO

SIGNIFICADO

Variable

Posicin del CM de las ruedas, respecto al eje x.

Variable

Velocidad del CM de la ruedas respecto al eje x.

Variable

Posicin del CM de la plataforma respecto al eje x.

variable

Velocidad del CM de la plataforma respecto al eje x.

Variable

Posicin del CM de la plataforma respecto al eje y.

Variable

velocidad del CM de la plataforma respecto al y.

Variable

Angulo de inclinacin respecto a la vertical.

Variable

Velocidad angular respecto eje z

variable

Velocidad angular de giro del vehculo respecto al eje Y

parmetro

Distancia del CM del sistema, respecto al eje de la rueda

parmetro

Distancia entre el centro del vehculo y el centro de la rueda

parmetro

Masa de la plataforma

parmetro

Masa de la rueda

parmetro

Momento de Inercia respecto al centro de masas de la plataforma en


inclinacin.

parmetro
parmetro

Momento de Inercia respecto al centro de masas de la plataforma en


giro.
Inercia de las ruedas.

parmetro

Torque del motor derecho e izquierdo respectivamente

Tabla 17. Parmetros principales del VEAU.

Se aplico, dinmica fundamental para el anlisis y obtencin del modelo


matemtico del sistema, el sistema simplificado se dividi en dos partes,
ruedas y plataforma, se analizo independiente las dos partes. En la figura 68 se
120

muestra el DCL de las ruedas izquierda y derecha con sus respectivos


parmetros que las caracteriza.

Figura 68. Diagrama de cuerpo libre ruedas izquierda y derecha.

Como las

ruedas se

desplazan horizontalmente, estas experimentan

aceleracin proporcional a las fuerzas externas aplicadas, de acuerdo a la


segunda ley de Newton se obtuvo las siguientes ecuaciones:

(1)

(2)

En el eje Y, la rueda no experimenta aceleracin:

121

(3)

(4)

Se aplico la ecuacin de sumatoria de torques en las ruedas izquierda y


derecha respecto al centro de masa de la rueda:

(5)

(6)

Debido al que el sistema de referencia est montado en el centro de la rueda


del vehculo:
(7)

Para el anlisis de las fuerzas que actan en la plataforma, se utiliz la figura


69 donde se muestran los parmetros que le caracterizan:

122

Figura 69. Diagrama de cuerpo libre plataforma.

Fuente: Grasser Felix, Darrigo Aldo, Colombi Silvio, Rufer Alfred; JOE: A Mobile Inverted Pendulum.

(8)

(9)

Se aplico la ecuacin de sumatoria de torques aplicados sobre la plataforma,


respecto al eje de las ruedas obteniendo:

123

(10)

Se aplico sumatoria de torques, respecto al centro del eje de la rueda, para


anlisis del giro del vehculo, en este caso el momento de inercia de la
plataforma se toma con respecto CM de la plataforma, en la figura 70 se
observa el vehculo en vista superior, donde el momento de inercia depende de
la distancia entre ruedas.

Figura 70. Vista superior del vehculo.

(11)

Se relaciono los desplazamientos del CM de la plataforma, con los del CM de la


rueda, observando la figura 71, se obtuvieron las siguientes relaciones:

124

Figura 71. Relacin de posicin entre la plataforma y las ruedas.

(12)

(13)

Se combino adecuadamente las ecuaciones (8 a 10) con las (12 y 13), se


obtuvo:

(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

LINEALIZACION DEL SISTEMA

Para simplificar el anlisis del sistema se realiz la linealizacin del sistema en


torno a un ngulo de cero grados, debido a que la posicin angular del CM de
la plataforma debe ser controlada para que siempre se mantenga a cero
grados, esto permite obtener el comportamiento dinmico del vehculo auto
balanceado, que es estabilizado haciendo un control de la inclinacin de la
plataforma.

126

Se realizo la linealizacin del sistema obteniendo:

(20)
(21)
(22)

Se combino las ecuaciones adecuadamente obteniendo:


(23)
(24)
(25)

127

Las ecuaciones (23 a 25) permiti observar un comportamiento simplificado del


sistema, la posicin, velocidad y aceleracin son dependientes del ngulo de
inclinacin de la plataforma, esto permite tener un control de la plataforma el
ngulo.
Para la accin de giro, (ecuacin 25) no hay dependencia de la posicin,
tampoco del ngulo de inclinacin, solo depende de la diferencia de torques de
los motores izquierdo y derecho.
Por el tanto se puede realizar control del ngulo, separadamente del control de
giro, y el movimiento lineal del vehculo queda dependiente del ngulo de
inclinacin.
3.3

DESACOPLE DE SUBSISTEMAS INCLINACION-GIRO

Debido a que el giro y el ngulo son dependientes de los torques de los


motores, debemos desacoplar los dos subsistemas, giro e inclinacin utilizando
torques virtuales asociados a cada subsistema estos torque virtuales se
definen:

De modo matricial se obtiene:


128

A la matriz de 2x2 que obtuvo es llamada matriz de desacople y permite


desacoplar los dos subsistemas involucrados, su inversa permite calcular cada
una de las acciones de control a cada motor una vez teniendo las acciones de
control virtuales, se obtienen las ecuaciones que simplifican el comportamiento
del vehculo:

(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:

Se obtuvo el torque virtual para el control de inclinacin


los motores sern.

129

, y los torques de

Para un torque virtual en giro

3.4

, se obtienen los torques para cada motor:

FUNCION DE TRANSFERENCIA

Para el anlisis de cualquier sistema de control continuo se requiere hallar la


funcin de transferencia, observando el comportamiento de manera analtica,
para obtener la funcin de transferencia del sistema dinmico, se utilizo la
funcin LINMODE2 (nombre del modelo en simulink), que entrega las matrices
de estado del modelo importado desde simulink, realizando una linealizacin en
torno a un punto de operacin optimo que escoge el software Matlab.
Para obtener la funcin de transferencia del sistema, se tomo las matrices del
espacio de estados y se calculo la funcin de transferencia del sistema, para
los parmetros establecidos que se indican en la tabla 18.
NOMBRE

VALOR

UNIDAD

DESCRIPCIN

0.75

[m]

Distancia del CM del sistema, respecto al eje de la rueda

0.7/2=0.35

[m]

Distancia entre el centro del vehculo y el centro de la rueda

50

[Kg]

Masa de la plataforma

[kg]

Masa de la rueda

9.357

Momento de Inercia respecto al centro de masas de la plataforma en


inclinacin.

2.0417

Momento de Inercia respecto al centro de masas de la plataforma en


giro.

0.0196

Inercia de las ruedas.

Tabla 18. Parmetros fsicos aproximados del VEAU

130

La funcin de transferencia obtenida, me relaciona la entrada que es el torque


con la inclinacin de la plataforma

La funcin de transferencia H(s), permite concluir que el sistema es altamente


inestable con polos en el eje real positivo, como lo muestra la grafica del lugar
de las races, de la figura 72, este sistema presenta polos en -5.78 y 5.78
puede ser estabilizado utilizando un regulador PD que reubica los polos en el
eje negativo real.

Polo positivo inestable

Figura 72. Grafica del lugar de las races del sistema.

131

Para poder hallar las constantes que controlen el sistema se realizo la


simulacin en Simulink, se aplico un regulador PD, y se obtuvieron los
resultados que se exponen a continuacin.

3.5

SIMULACION DEL SISTEMA DINAMICO

La simulacin del sistema se realizo con en el software de simulacin dinmica


SIMULINK, junto con programacin en MATLAB, la simulacin consiste en
introducir las ecuaciones diferenciales obtenidas en el desarrollo del modelo
matemtico, con parmetros y variables que se indicaron en la tabla 17, Se
indican cuales son las entradas, salidas y perturbaciones del sistema.
La programacin en MATLAB se hizo, para introducir los valores de los
parmetros fsicos del sistema, en simulink, adems para la obtencin de un
modelo linealizado del modelo principal, modelado en el espacio de estados
con sus matrices respectivas, y la funcin de transferencia del sistema.
El sistema desarrollado requiere de un control de inclinacin, este control busca
siempre mantener el vehculo en su posicin vertical, por lo tanto el setpoint es
fijo y el valor es de 0 de inclinacin. El control de movimiento del vehicul se
hizo perturbando la inclinacin del sistema, por lo tanto el pasajero controla el
movimiento del vehicul inclinndose en el sentido que se quiera desplazar.
Esta perturbacin de inclinacin del pasajero se simula como un torque
suministrado a las ruedas aplicado en sentido contrario a la inclinacin que
requiera el pasajero, la figura 73 ilustra esta perturbacin.

132

Figura 73. Perturbacin del sistema, aplicada por el pasajero.

Los parmetros se introducen inicialmente dentro del Workspace de Matlab,


que luego son enviados a Simulink. La figura 74 podemos observar el modelo
del sistema completo.

Figura 74. Simulacin del sistema dinmico, Simulink

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.

Figura 75. Bloque subsistema, del sistema dinmico VEAU

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

Figura 76. Sistema de control PD, aplicado al sistema dinmico VEAU.

Se Suministro un tren de pulsos como perturbacin; con amplitud de 20 N.m,


ilustrado en la figura 77.

Figura 77. Seal de entrada al sistema, como perturbacin.

Obteniendo una respuesta de ngulo de inclinacin, velocidad y torque, para


constantes Kp y Kd calculadas por el auto sintonizador del bloque PID de
MATLAB; estas constantes se obtienen para un tiempo de establecimiento y
overshoot (Es necesario que el sistema no supere el 10 %, para no alejarse del
rango lineal) configurados en el auto-sintonizador del bloque PID que ofrece
SIMULINK, las figuras 78 y 79 se observa el comportamiento de inclinacin y
velocidad del sistema respectivamente. En la tabla 19 se incluyen estas
constantes y cada uno de sus efectos en el control del sistema.
135

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.

Figura 78.inclinacion del vehculo.

Figura 79. Velocidad lineal del vehculo en m/s.

De la grafica de inclinacin se concluye; al perturbar el sistema se logra inclinar


el vehculo hasta 0.7 en los cuales se estabiliza en 0.65 , el vehculo se
136

mantiene a una velocidad en incremento hasta los 0.6 m/s, cuando la


perturbacin se retira el vehculo vuelve al setpoint establecido, que son cero
grados respecto a la gravedad, el tiempo de estabilizacin es de 0.4 segundos.
El torque de estabilizacin que entrega el motor para una inclinacin de 0.6 es
de 0.25 N.m, el cual se mantiene oscilando alrededor del cero cuando el
vehculo est en la posicin vertical.
Se observa que el vehculo es controlado satisfactoriamente utilizando tcnicas
de control Proporcional y derivativo.

3.6

REQUERIMIENTOS TECNICOS

Luego del desarrollo del modelo matemtico, se selecciono los sensores


necesarios para medir las variables de estado del sistema, para realizar el
control retroalimentado, segn el anlisis que se llevo a cabo en el capitulo
anterior, se concluyo que las variables de estado a medir para tener un control
del vehculo son:
Inclinacin (): Es la variable principal a medir ya que el movimiento del
vehculo y su estabilizacin dependen de esta variable.

Velocidad lineal ( ): Es la velocidad lineal del vehculo, dependiente de


la velocidad de ambas ruedas.

Referencia del giro ( ): es la velocidad angular de giro del vehculo,


bsicamente es dependiente de la diferencia de velocidad de ambas
ruedas, que giran en sentidos contrarios.

Estado de bateras: Debido que los actuadores (motores) deben ser


alimentados correctamente y suministrando una corriente necesaria para
producir el respectivo torque para la estabilizacin, se debe monitorear

137

constantemente el estado de las bateras y de las fuentes de


alimentacin.

Corriente en motores: Para proteger la etapa de potencia del sistema, se debe


monitorear la corriente que se entrega a los motores.

138

4.1

CONTROL PID

INTRODUCCION

El controlador PID (Proporcional, Integral y Derivativo) es un controlador


realimentado cuyo propsito es hacer que el error en estado estacionario, entre
la seal de referencia y la seal de salida de la planta, sea cero, lo que se
logra. Adems el controlador tiene la capacidad de anticipar el futuro.

4.2

EL PRINCIPIO DE REALIMENTACION

La idea de la realimentacin es bastante simple y muy poderosa. A lo largo de


su historia, ha tenido una fuerte influencia en la evolucin de la tecnologa. Las
aplicaciones del principio de realimentacin han tenido xito en los campos del
control, comunicaciones e instrumentacin. Para entender el concepto, se
asume que el proceso es tal que cuando el valor de la variable manipulada se
incrementa, entonces se incrementan los valores de las variables del proceso.
Bajo este concepto simple, el principio de realimentacin puede ser expresado
como sigue

Incrementar la variable manipulada cuando la variable del proceso sea ms


pequea que la referencia y disminuirla cuando sta sea ms grande.
Este tipo de realimentacin se llama realimentacin negativa debido a que la
variable manipulada se mueve en la direccin opuesta a la variable del
proceso. El principio puede ser ilustrado por el diagrama de bloques que se
muestra en la figura 80. En este diagrama el proceso y el controlador estn
representados por cajas negras y las flechas denotan las entradas y salidas a
cada bloque. Existe un smbolo especial que denota una suma de seales. El
diagrama de bloques muestra que el proceso y el controlador estn conectados

139

en un lazo realimentado. La presencia del signo en el bloque de retorno indica


que la realimentacin es negativa.

Figura 80. Diagrama de bloques del sistema de control de un proceso

4.3
El

mecanismo

de

CONTROL ON-OFF

realimentacin

ms

simple

se

puede

describir

matemticamente como sigue:

(29)

Donde e = y - y sp es la diferencia entre la referencia especificada por el


operador y la salida medida del proceso, lo que se denomina error de control.
Esta condicin de control implica que siempre se usa la accin correctiva
mxima. De esta manera, la variable manipulada tiene su valor ms grande
cuando el error es positivo y su valor ms pequeo cuando el error es negativo.
El proceso de control de este tipo se llama control on-off. Es simple y no tiene
parmetros que configurar, aparte de las acciones mnima y mxima que se
ejecutan en el clculo de la seal de control. El control on-off muchas veces es
apropiado para mantener la variable controlada del proceso cerca del valor de

140

la referencia que fue especificada, pero tpicamente resulta en un sistema


donde las variables oscilan.

Se puede ver en la ecuacin 29 que la variable de control no est definida


cuando el error es cero. Es comn tener algunas modificaciones ya sea
introduciendo histresis o una zona muerta como se muestra en la Figura 81.

Figura 81. (A) Caracterstica de un controlador On-Off ideal, (B) con Zona muerta y (C) Histresis.

4.4

CONTROL PROPORCIONAL

La razn por la que el control on-off resulta en oscilaciones es que el sistema


sobreacta cuando ocurre un pequeo cambio en el error que hace que la
variable manipulada cambie sobre su rango completo. Este efecto se evita en
el control proporcional, donde la caracterstica del controlador es proporcional
al error de control cuando stos son pequeos. La figura 82 muestra la
caracterstica de un controlador proporcional. De esta manera, el controlador
est caracterizado por la funcin lineal
control, que se muestra en la figura.

141

, dependiente del error de

Figura 82. Caracterstica de un control proporcional, la entrada es el error e y la salida es la seal de


control u.

4.5

ERROR ESTACIONARIO

El control proporcional presenta el problema que la Variable de Proceso (Pv)


jams se estabilizar justo en el valor del Setpoint. La razn es fcil de
entender recurriendo a un ejemplo. Suponiendo que la Pv es la temperatura de
un horno, la cual se estacionar en 200 C en forma estable y permanente,
entonces la salida sera 0%. Pero siempre es necesario suministrarle al horno
algo de potencia, por lo menos cmo para compensar las prdidas de calor al
medio ambiente o calor contenido en el material que sale del horno.

Es evidentemente imposible que el horno se mantenga a 200C con los


calefactores permanentemente apagados. Luego la temperatura tiene que
descender un poco, lo suficiente para que la potencia de suministrada por los
calefactores sea igual a las prdidas de energa del horno (energa que sale del
horno).

El error estacionario se puede disminuir reduciendo la banda proporcional, pero


reducirla mucho implica que el sistema oscile y se comporte como un control

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

Otra forma de corregir el error estacionario es incorporar al control


Proporcional, la accin Integral, llamado tambin a veces "automatic reset" o
"reset action".

El control ser el mismo proporcional, pero a la salida se le suma la accin


integral, que la corrige tomando en cuenta la magnitud del error y el tiempo que
este ha permanecido. Para ello se le programa al control una constante Ki, que
es formalmente "la cantidad de veces que aumenta la accin proporcional por
unidad de tiempo".

La salida se corrige en una cantidad equivalente a la integral del error


multiplicada por Ki. La ecuacin (30) representa de forma discreta la accin del
trmino integral.
(30)

4.7

ACCIN DERIVATIVA

Un control PD es uno proporcional al que se le agrega la capacidad de


considerar tambin la velocidad de cambio de la Pv en el tiempo. De esta forma
se puede "adelantar" la accin de control del mando de salida para obtener as
una Pv ms estable. Si la Pv est por debajo del Sp, pero subiendo muy
143

rpidamente y se va a pasar de largo el Sp, entonces el control se adelanta y


disminuye la potencia de salida.

Al revs si la Pv es mayor que el Sp, la salida debera ser 0% pero si el control


estima que la Pv cae muy rpido y se va pasar para abajo del Sp, entonces
coloca algo de potencia para ir frenando el descenso brusco.
La accin derivativa es llamada a veces "rate action" por algunos fabricantes de
controles porque considera la "razn de cambio" de la Pv. La ecuacin (31)
representa de forma discreta la accin del trmino derivativo
(31)

4.8

CONTROL PROPORCIONAL INTEGRAL DERIVATIVO PID

Un control PID es un controlador proporcional con accin derivativa y accin


integral superpuestas.
La ecuacin 32 rene los trminos componen el sistema de control PID.
Es fundamental para el correcto funcionamiento del control PID la eleccin de
los parmetros

. Existe un conjunto de estos valores que darn el

rendimiento ptimo y encontrarlos requiere: conocimientos tericos, habilidad


obtenida mediante la experiencia y suerte.

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

ESTABILIZACIN DEL SISTEMA

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.

En la Figura 83 se muestran ejemplos de estos comportamientos. En cada uno


de estos casos vara la velocidad de respuesta del sistema ante perturbaciones
y a la vez la propensin a tener comportamiento inestable u oscilatorio.

El sistema sobre-amortiguado tiene una velocidad de respuesta lenta, despus


que ocurra una perturbacin, el sistema puede tardar en volver al Sp, pero la
ventaja es que el sistema es muy estable y no adquiere comportamientos
oscilatorios indeseables.

145

Figura 83. Ejemplos de comportamientos control sub amortiguado, control con amortiguamiento crtico y
control sobre amortiguado

El sistema sobre-amortiguado tiene una velocidad de respuesta lenta, despus


que ocurra una perturbacin, el sistema puede tardar en volver al Sp, pero la
ventaja es que el sistema es muy estable y no adquiere comportamientos
oscilatorios indeseables.

Esta condicin tiende a ocurrir cuando la banda proporcional Pb es ms grande


de lo necesario. Tambin puede deberse a una constante derivativa D muy

146

grandes, basta acordarse que la accin derivativa tiende a frenar la


temperatura.

En el otro extremo, cuando un sistema se comporta de modo sub-amortiguado


la velocidad de respuesta es muy buena pero pueden ocurrir varias
oscilaciones de cierta amplitud antes que la temperatura llegue a un valor
estable.

Suele ocurrir esta condicin cuando la banda proporcional es

pequea, la constante derivativa

chica y la constate de integracin

grande.

El justo medio entre las condiciones anteriores es el amortiguamiento crtico. A


esta condicin corresponde los valores ptimos de los parmetros
En este caso el sistema es bastante estable y la velocidad de respuesta es la
mejor que se puede lograr.

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

: La medida de esta variable permite hacerse una

idea de la velocidad con la que el VEAU est cayendo o se est levantando,


permitiendo crear una salida predictiva sobre la planta. Se puede medir
directamente con un giroscopio o indirectamente con un sensor de inclinacin,
tomando cada valor adquirido y comparndolo con el anterior, es decir,
sacando su derivada.
Error: Es la diferencia entre la variable medida o Variable de Proceso y el
SetPoint. Para este caso indica que tan inclinado esta el vehculo respecto de
la Posicin de Equilibrio.
SetPoint: Para este sistema, el SetPoint es el punto donde el sistema se
mantiene en un equilibrio momentneo o de inclinacin cero, es decir, colineal
con el eje vertical que pasa por la Posicin de Equilibrio del sistema.
Byas: Es un valor de PWM, el cual equivale para este caso a una diferencia de
potencial en las entradas de los motores, en el cual se considera que el
sistema est en movimiento inminente, es decir, con solo un pequeo aumento
en el PWM (voltaje en los motores), el sistema entrara en movimiento.

148

5.1.1

Compensacin de la inclinacin con giroscopio

Variable de Proceso

: Cuando el sensor usado para medir la inclinacin del

sistema es un acelermetro, el movimiento Lineal acelerado y Rotacional del


vehculo afectan la medida de este, por lo tanto se hace necesario implementar
un algoritmo que contrarreste el aumento en la medida de inclinacin.
Restando el incremento en la medida del giroscopio multiplicado por una
constante

al valor obtenido con el acelermetro se puede disminuir este

efecto indeseado. De tal forma que la variable de Proceso

se pude expresar

como:

Donde

es la medida tomada por el acelermetro y

es la variacin

entre una medida y la anterior del giroscopio.


El valor final obtenido es la Variable de Proceso

es usada para calcular el

del sistema y las condiciones de inclinacin para determina el sentido y la


magnitud del giro de las ruedas.
Si el sensor usado para medir la inclinacin es uno tal que no se afecte con las
aceleraciones del sistema, tal como un inclinmetro o sensor de distancia, el
procedimiento anterior se vuelve innecesario.
5.1.2

Parmetros del

Proporcional

: Este trmino permite entregarle al sistema una potencia que

vara de forma proporcional al

. De tal forma que si el error crece o para

este caso, el vehculo se inclina ms, la energa que le llega a los motores
tambin aumenta proporcionalmente en un factor

El clculo de este parmetro se calcula por medio de la expresin:

es la constante que multiplica al error del sistema, obteniendo as la salida


proporcional de este.
149

Derivativo

: Por medio de este trmino se puede adelantar la accin de

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 (

) se encuentra por debajo del

), pero se va acercando a este rpidamente,

entonces el control se adelanta y disminuye la potencia en los motores para


que el sistema no vaya a pasar de largo el

. Ahora, si en un

determinado instante el vehculo ya paso por el

y adems de eso cae

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

es el error calculado con

los datos en la toma de datos inmediatamente anterior.


Integral : Es de uso comn este trmino en control para la correccin del error
estacionario de un sistema, el cual para este caso no ser otra cosa ms que
una perturbacin (inclinacin) constante por parte del usuario.
Para cada inclinacin del vehculo se tiene una salida proporcional a la
magnitud de sta, el trmino derivativo complementa la salida proporcional,
siempre y cuando el vehculo est rotando con respecto al eje de sus ruedas.
Pero qu ocurre si el usuario mantiene una inclinacin casi constante de tal
forma que el giroscopio no registe una velocidad significativa de giro y el valor
de la derivada sea mnimo? Si para evitar que el vehculo caiga se requiere de
una aceleracin lineal para contrarrestar la componente de la gravedad que
hala al vehculo hacia el piso. Por lo tanto se hace necesario incluir el trmino
integral , el cual tiene en cuenta el tiempo que el sistema ha estado fuera de
su posicin de equilibrio incrementando la salda del sistema de forma
proporcional al

y al tiempo que este se mantenga

En otras palabras el trmino integral suma los errores en el tiempo, los


multiplica por una constante

y agrega este incremento a la salida en PWM

150

El clculo de este parmetro se calcula por medio de la expresin:

Velocidad de Giro : Este trmino es importante para le estabilidad del sistema,


puesto que es bastante sensible a cualquier giro que realice el vehculo
respecto del eje de sus ruedas y no se afecta por movimientos lineales, lo que
permite hacer una compensacin al acelermetro. Se adquiere por medio del
giroscopio. El valor registrado por este sensor, adems de la compensacin,
se tom como un cuatro parmetro en la ecuacin del PID, multiplicado por su
constante respectiva

El clculo de este parmetro se calcula por medio de la expresin:

Donde

son el SetPoint del giroscopio en cualquier

posicin sin movimiento y el valor ledo del giroscopio, respectivamente.

5.1.3

Secuencia de control

Inicialmente se implemento una estrategia de control como se observa en la


figura 84, se observa la obtencin de las seales de los sensores (acelermetro
y giroscopio), pasando antes por sus respectivos filtros pasa baja de segundo
orden, con el setpoint definido como cero, se aplico una estrategia de control
PID integrada con un giroscopio G, luego de la aplicacin de esta estrategia de
control , se obtiene la seal de control que debe llegarle a los puente H, que
manejaran la alta corriente que consumen los motores, as segn la
perturbacin que se le suministre al sistema se obtiene movimiento del vehculo
en un sentido u otro.

151

Figura 84. Esquema 1 de la secuencia de control del VEAU.

5.2
5.2.1

IMPLEMENTACION DE LOS SENSORES

Ubicacin

De la configuracin fsica del vehculo depende la ubicacin del acelermetro


(el giroscopio funciona independientemente de la ubicacin sobre el vehculo).
Se tienen dos principales formas de distribuir la masa del vehculo, si se quiere
hacer un control de equilibrio usando como sensor principal de inclinacin un
acelermetro. Ruedas livianas (poca inercia) con la mayor cantidad de masa
ubicada lo ms arriba posible y ruedas masivas (mucha inercia) con poco peso
en la parte superior.
En la primera configuracin que se observa en la figura 85, la parte superior del
vehculo, la ms pesada, es decir la que tiene mayor inercia, va a presentar un
movimiento lineal (adelante, atrs) significativamente menor que la parte
inferior del vehculo. Esto debido a que mientras sea ms masivo, ser menos
susceptible a vibraciones, y en tanto que si el centro de gravedad se encuentra
alejado del eje de rotacin, el momento de inercia de ste aumenta, por lo que
152

se vuelve ms lento, dando un mayor tiempo para controlar el sistema. El


problema de esta disposicin es que requiere de una mayor potencia para
realizar el control, por lo cual no se puede alejar mucho el centro de gravedad
del eje de giro de las ruedas.
Conociendo el comportamiento del vehculo en la primera configuracin y
sabiendo que el acelermetro es sensible a los movimientos lineales
acelerados, es conveniente que el sensor se ubique en la parte superior, en la
figura 86 se ilustra la disposicin de los sensores giroscopio y acelermetro en
la parte superior del vehculo.
En la segunda opcin, el comportamiento del vehculo es diferente, la parte
superior se mueve ms que la inferior. Para comprender mejor su
funcionamiento se puede pensar que en el caso lmite en que las ruedas sean
muy pesadas, el efecto seria tal como si estas estuvieran bloqueadas respecto
al piso, por lo tanto el torque que se generara en el motor tan solo lograra que
se mueva la parte superior del sistema, por lo tanto all es donde se debe
generar mayor movimiento. Suponiendo que se usara esta configuracin, los
sensores, segn lo dicho anteriormente deben ir ubicados en la parte inferior
del vehculo que es donde se genera menor movimiento lineal.
Dado que la mayor cantidad de peso del sistema la aporta el usuario, no es
posible usar la segunda configuracin, pues requerira unas ruedas muy
pesadas (o gran inercia), lo que incrementara la cantidad de energa requerida
para mover el sistema, adems de lo lento que este sera. Por lo tanto la
primera configuracin terica se adapta mejor al VEAU, siempre y cuando el
sensor usado para la inclinacin sea un acelermetro. Otros sensores tales
como sensores de distancia o inclinmetros no se veran afectados por la
ubicacin en el vehculo.

5.2.2

Filtrado y prueba de los sensores

153

Antes de la instalacin de los sensores se realiz una prueba para verificar su


respuesta en dos condiciones, reposo y movimiento leve.
Para dicha prueba se tomaron 1000 datos en cada condicin, los cuales se
graficaron el Matlab, ver figuras 88 y 89.
Para la adquisicin de los datos se realiz el montaje que se observa en la
figura 85 y 86.
El filtro analgico pasa bajas de segundo orden que se diseo y construyo,
para la eliminacin de ruido de altas frecuencias, se muestra montado en placa
en la figura 87, en esta placa se observan dos filtros iguales debido a que se
requiere filtrar las seales de dos sensores acelermetro y giroscopio.

Figura 85. Montaje para la realizacin de pruebas de los sensores.

154

Figura 86. Ubicacin de los sensores en la parte superior del vehculo de pruebas.

Figura 87. Etapa de Filtrado Analgico.

5.2.2.1 Sistema en estado de reposo

Las lneas azules representan la seal obtenida directamente del acelermetro


y del giroscopio, mientras que la verde representa la seal de cada sensor
luego de pasar por un filtro pasa-bajos activo analgico y un filtro digital
promediador, con un nmero de muestras de 100 para el acelermetro y 10 el
giroscopio respectivamente, como se puede observar en las figuras 88 y 89, se
observa que la seal que proviene directamente de los sensores trae consigo

155

ruido, el cual opaca la variacin de la salida de cada sensor debida a la


inclinacin del dispositivo, adems de que genera ciertos picos que el sistema
de adquisicin tomar como inclinacin del sistema generando una salida hacia
los motores no necesaria. Por lo tanto se hace indispensable la implementacin
de una etapa de filtrado.

Figura 88. Acelermetro en estado estacionario

Figura 89. Giroscopio en estado estacionario.

5.2.2.2 Sistema sometido a pequeas perturbaciones (inclinaciones)

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

se observa un comportamiento menos ruidoso, pero mucho ms tenue,


observando que la informacin real de inclinacin despus del filtro es de mala
calidad, lo cual tampoco favorece el control del sistema pues as se hacen
menos notorias las perturbaciones, lo que se sugiere es complementar esta
seal con la seal proveniente del giroscopio, adems de realizar un promedio
con un nmero menor de muestras.
En la figura 91 ( correspondiente al giroscopio se observan los mismos picos y
crestas que con el acelermetro, a diferencia de la seal tomada directamente
del sensor (lnea azul) que es mucho mas limpia y al aplicar el filtro se
elimina el ruido considerablemente con tan solo un pequeo desfase entre la
seal sin filtrar y la filtrada, permitiendo hacer un complemento importante a la
seal tomada por el acelermetro pues la seal filtrada del giroscopio al tener
un desfase mnimo permite tener en cuenta los movimientos rpidos para el
clculo del PID-G.

Figura 90. Acelermetro en movimiento oscilatorio leve

Figura 91. Giroscopio en movimiento oscilatorio leve

157

5.3

SINTONIZACIN DEL SISTEMA

Para la sintonizacin (estimacin de las constantes) del sistema, se utiliz el


mtodo de prueba y error, iniciando generalmente con valores bajos de las
constantes.
Comandos del Arduino usadas para la sintonizacin del sistema:
AnalogRead(x): Usada para adquirir la seal proveniente del potencimetro
entre 0 y 5 volts, la cual es convertida en el conversor analgico-digital a un
nmero entre 0 y 1023. Donde x es el nmero del pin (ente 0 y 15 para el
Arduino MEGA) de la entrada analgica (ANALOG IN) que se est usando.
AnalogWrite(x, y): Usada para generar una escritura como seal de control
para mover los motores. La salida es en PWM y va de 0 a 255, lo que equivale
a una seal de 0 a 5 volts donde x es el nmero del pin (entre 2 y 13 para el
Arduino MEGA) de la salida en PWM y y es la variable que se quiere como
salida en el pin x.
serial.Print(x): Usada para visualizar en pantalla (Serial Monitor, del Arduino), la
variable x.
Delay(x): Permite hacer una pausa de x milisegundos en el programa.

5.3.1

Procedimiento para modificar y visualizar los valores

Setpoint: Manualmente se llev el sistema a su posicin de equilibrio y por


medio de la funcin serial.Print () del Arduino se visualiz en el Serial Monitor el
valor que indicaba el acelermetro en este punto, se realizaron varias
mediciones, y se tomo el valor que ms se repiti.
Byas: Usando un programa de control On-Off se calculo este valor.
Dependiendo de la inclinacin del vehculo, las ruedas giran en sentido horario
o anti-horario a una salida de PWM fija. La magnitud del PWM hacia el motor

158

gradu con un potencimetro corriente para cada sentido de rotacin y se


visualiz su valor por medio de la funcin serial.Print () del Arduino.
Se inici con un valor suficientemente alto como para que el sistema entrara en
movimiento cada vez que el sistema cambiara de inclinacin, con lo que se
obtuvo un movimiento oscilatorio alrededor del SetPoint.
Se redujo gradualmente con los potencimetros la salida en PWM hacia cada
lado, hasta llegar a una amplitud en la oscilacin del sistema imperceptible o
nula. Se obtuvo un valor diferente de byas para cada sentido de giro del motor.
Constante Proporcional

: Esta constante se calcul usando un cdigo de

control Proporcional + byas en el cual los valores de

se graduaron por

medio un potencimetro para cada sentido de giro. Dichos valores se


visualizaron usando de la funcin serial.Print() del Arduino. Se inici en valores
bajos y se fue aumentando mientras de verificaba la respuesta del sistema,
hasta llegar a una oscilacin constante cuando el sistema se encontraba
alrededor del SetPoit, y donde adems se observ una respuesta del sistema
ante una perturbacin de algunos pocos grados, tal que el vehculo no se
cayera hacia el lado donde se perturbaba.
Constante Derivativa

: Luego de tener el valor de la constante proporcional,

con la cual el sistema muestra un comportamiento de oscilacin casi constante


alrededor del SetPoint, gradualmente se aumentaron los valores de la
constante derivativa Kd usando un potencimetro, hasta reducir la oscilacin
del sistema, es decir, que este alcance la posicin de equilibrio en un tiempo
corto con el menor overshoot posible. El valor de esta constante se visualiz
usando de la funcin serial.Print() del Arduino, a medida que se iba
modificando con el potencimetro.
Constante Giroscpica

: Con un potencimetro se fue graduando el valor de

Kg iniciando en valores pequeos y aumentando lentamente hasta llegar a un


valor en donde el comportamiento sea aceptable respecto de valores por
encima y por debajo de este. El valor de esta constante se visualiz usando de
la funcin serial.Print () del Arduino, a medida que se iba modificando.
159

DISEO ESTRUCTURAL DEL VEAU

160

El VEAU est compuesto por una serie de subconjuntos los cuales de


muestran en la figura 92 y se listan a continuacin:

Bastidor del vehculo o estructura base.


Mecanismo de deslizamiento.
Soporte de bateras.
Sistema de potencia y transmisin
Silla
Mecanismo barra de direccin

Figura 92. Representacin del VEAU en SolidWorks.

161

A continuacin se lista cada una de las partes principales que conforman al


VEAU, se explica su funcin, caractersticas principales, se muestran algunas
fotografas, grficos hechos en SolidWorks y de algunos componentes, los ms
representativos para el sistema, se muestran dos imgenes que provienen del
anlisis hecho en Ansys Workbench, una de esfuerzos y otra de
deformaciones.

6.1

BASTIDOR DEL VEHCULO

Bastidor del Vehculo: Encargada de dar soporte a todos los dems


subsistemas del vehculo, adems del peso del usuario. Se encuentra
compuesto por dos perfiles cuadrados de acero estructural Colmena (Ver figura
94), dispuestos en forma paralela uno respecto del otro a lo ancho del VEAU.
La figura 93 muestra el bastidor del vehculo junto con los componentes que
causan algn tipo de carga sobre este.

Figura 93. Bastidor junto con los componentes. Representacin hecha en SolidWorks.

162

Figura 94. Fotografa de una de las barras.

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

Factor de Seguridad: 1.63


Dimensiones: 550 x 25.4 x 25.4, espesor de
pared 2.5 mm

Tabla 20. Caractersticas Bastidor.

6.2

MECANISMO DE DESLIZAMIENTO

Se encuentra compuesto por cuatro soportes verticales de acero, dos tubos de


aluminio y cuatro conjuntos de rodillos. El sistema completo de puede ver en la
figura 96.

Figura 96. Mecanismo de deslizamiento. Representacin hecha en SolidWorks

165

6.2.1 Soportes
Soportan los Tubos del Riel. Hechos de seccin cuadrada de un perfil de 1
(ver figura 97).

Figuras 97. Representacin del soporte en SolidWorks y Fotografa, respectivamente.

Para su anlisis en Ansys se distribuy un peso mximo sobre la estructura de


100 Kg, dividido en cada una de las cuatro bases, equivalente a 25 Kg. Se
observa la respuesta de los soportes a la aplicacin de la carga en cuanto a
deformacin y esfuerzos en la parte superior e inferior de la figura 98
respectivamente, con lo que se obtuvo un factor de seguridad superior a 15. En
la tabla 21 se listan las caractersticas principales

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.

Carga Aplicada: 25 Kg.

Tabla 21. Caractersticas Soporte Tubo Riel.

6.2.2

Tubos Riel

Sobre estos tubos se deslizan los rodillos. Soportan el peso de la silla y la


persona. Las figuras 99 y 100, ilustran el Tubo Riel y la disposicin de este,
junto con los dos componentes ms cercanos.

Figura 99. Tubo Riel del mecanismo de deslizamiento. Representacin hecha en SolidWorks.

168

Figura 100. Fotografa Tubo Riel del mecanismo de deslizamiento.

Para el anlisis en ANSYS Workbech se le aplic una fuerza de 250 N en cada


extremo correspondiente a un cuarto del peso mximo para el que fue
diseada la estructura.
Para las condiciones de apoyo y carga sobre los Tubos Riel, el factor de
seguridad es de N = 2,95. El la figura 101 se ve la respuesta del sistema en
cuanto a deformacin y esfuerzos respectivamente, en la tabla 22 se listan las
caractersticas principales

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

giros, si se sabe de antemano que soportan bien el peso de una

persona, adems, traen un par de tapones que permiten ajustarlos axialmente


con el tornillo especial para patines, se consiguen fcilmente en el comercio
local y son econmicos.

171

Figura 102. Rodamientos usados en los rodillos.

Los rodillos se dimensionaron de tal forma que se pudiera usar tornillos


estndar para patines, junto con sus respectivos rodamientos, por lo tanto,
estos tienen el ancho aproximado de una rueda de patn.
Cada conjunto de Rodillos consta de dos rodillos debidamente distanciados y
apoyados sobre rodamientos montados en una base en forma de C hecha con
lmina de dos milmetros de acero inoxidable
Las Figuras 103 y 104 muestran el rodillo y el conjunto de rodillos
respectivamente.

Figura 103. Rodillo. Representacin hecha en SolidWorks.

172

Figura 104. Fotografa de un conjunto de rodillos.

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

Figura 105. Representacin en Ansys de un Rodillo, Anlisis deformacin y esfuerzos respectivamente.

174

CARACTERSTICAS
Material: Nylon
Factor de Seguridad: 13,9.
Carga Aplicada: 25 Kg.

Tabla 23. Caractersticas del Rodillo

6.3

SOPORTE DE LAS BATERAS

Se trata de un perfil en L de 3/4 doblado y soportado por el bastidor del


vehculo. Las figuras 106 y 107 muestran el soporte solo y el soporte junto con
los componentes con lo que este interacta.

Figura 106. Soporte Bateras junto con sus componentes ms cercanos. Representacin hecha en
SolidWorks.

175

Figura 107. Soporte Bateras. Representacin hecha en SolidWorks.

Figuras 108. Fotografa Soporte Bateras

Peso de dos bateras, Pb=15 Kg.


Presin ejercida por las bateras sobre el soporte, 30500 Pa (para clculos en
ANSYS Workbench). Para lo cual se obtuvo un factor de seguridad mayor que
N = 15. La figura 109 muestra el comportamiento del soporte de las bateras
bajo el peso de estas, en cuanto a deformacin y esfuerzo.

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.

Tabla 24. Caractersticas del Soporte de Bateras.

6.4 SISTEMA DE POTENCIA Y TRANSMISIN


Compuesto por dos salidas de potencia, cada una de ellas compuesta por:
6.4.1

Motor DC

En la figura 110 se observa, los motores utilizados inicialmente en el modelo de


pruebas, se observa el modelo en SolidWorks y una fotografa del mismo.
En la tabla 25 se incluyen las caractersticas principales de los motores
utilizados en el modelo de pruebas.
En la figura 111 se observa, uno de los motores utilizados en el vehiculo
terminado, son motores de 12 Volts y de alta potencia

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

Tabla 25. Caractersticas del Motor MATSUHITA.

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

Tabla 26. Caractersticas del Motor BANEBOTS.

180

6.4.2

Eje

Calculo de los requerimientos del sistema.


Tabla de requerimientos de torque del sistema basado en las ecuaciones, por
motor.
= Masa del vehculo ms la del pasajero / 2 pues se calcula para un solo
motor, en Kg.
= Aceleracin a la que debe moverse el sistema para no caer, en m/s2
= Angulo de inclinacin del sistema respecto de la vertical, en radianes.
= Torque requerido por el sistema para mantenerse a una aceleracin
constante dependiendo del ngulo de inclinacin en el que se encuentre, en
Nm.
= Radio de la rueda, en metros.

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

Torque mximo en el motor: 0.3178 Nm


Reduccin: 16:1
Torque a la salida del reductor: 14.5 Nm = 128 Lb-pulg.
De acuerdo con la tabla 27 se espera que el sistema sea capaz de responder
adecuadamente hasta una inclinacin de 11 para un peso del conjunto
vehculo pasajero de 100 Kg.
Conociendo el torque mximo entregado por los motores se calcula la cua
ubicada entre el eje y el acople manzana-eje.
Se elige un ancho de cua W estndar de 1/4.
Clculo de la longitud de la cua.

Por efectos de maquinado se realizo una cua de 1.5 cm, longitud superior a la
requerida. Material, acero AISI 1020.

Diseo del eje.


Se presume hay dos puntos sobre el eje los cuales estn sometidos a un
esfuerzo mayor, el apoyo sobre la chumacera y el punto donde se ubica el
cuero.
Distribuyendo el peso de la persona y del vehculo en
corresponde a cada eje aproximadamente 100 Lb de carga.
Apoyo sobre la chumacera.

182

las dos ruedas

Figura 112. Diagrama de fuerzas, cortante y momentos sobre el eje en la seccin de la chumacera

Aplicando la ecuacin [14]

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

Punto donde se ubica el cuero.

Figura 113. Diagrama de fuerzas, cortante y momentos sobre el eje en la seccin de la cua

Aplicando la ecuacin [14]

D=3/4
k= 2 Para cuero de perfil.
M=190 Lb*Pulg
Sn=72000 Psi
Sy=42000Psi
T=128 Lb*Pulg

184

Solucionando para N se obtiene un factor de seguridad de N=7. Con al cual se


puede asegurar que la resistencia del eje est por encima del requerimiento
terico en la parte del eje donde se ubica el cuero.

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

Para su anlisis en ANSYS se tuvo en cuenta la fuerza radial en el sitio donde


se ubica la rueda, el momento ejercido por el motor, el cual es transmitido a la
rueda a travs de la chaveta y las restricciones radiales que hacen los
cojinetes.
La figura 113 muestra el comportamiento del eje soporte de las bateras bajo el
peso de estas, en cuanto a deformacin y esfuerzo.

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.

Tabla 28. Caractersticas del Eje-Acople.

6.4.3

Chumacera

Se seleccionaron chumaceras con rodamientos de la marca FK, referencia


P2049. Al trabajar a baja velocidad, no hay restriccin por este motivo y
respecto a la carga radial, el lmite de este rodamiento es de 9880 N, muy
superior a la carga a la cual van a estar sometidos, la cual ser el peso del
vehculo mas el de la persona. Ver figura 114.

www.fk-bearings.com

187

Figura 116. Representacin el SolidWorks y Fotografa de una de las chumaceras.

CARACTERSTICAS
Chumacera con rodamiento de bolas
Marca FK, referencia P204.
Carga mxima radial Soportada: 9880 N
Carga mxima Aplicada: 1000N.

Tabla 29. Caractersticas de las Chumaceras

6.4.4

Manzana de freno de disco

Se aprovech la entrada de los tornillos de la manzana para el freno de disco


para fijar el acople que permite la transmisin de torque, en la figura 115 se
observan las manzanas para freno de disco utilizadas en el modelo.

188

Figuras 117. Representacin el SolidWorks y Fotografa de una de las Manzanas .

CARACTERSTICAS
Material: Aluminio.
Marca: K9
Carga Aplicada: 50 Kg.

Tabla 30. Caractersticas de las manzanas.

6.4.5

Acople entre el eje y la manzana

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

Figuras 118. Representacin el SolidWorks y Fotografa de Acople Eje-Manzana

190

Para su anlisis en ANSYS se tuvo en cuenta la fuerza radial de compresin a


la que se encuentra sometida y el torque que proviene del motor. La figura 117
muestra el comportamiento del Acople Eje-Manzana, en cuanto a deformacin
y esfuerzo.

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.

Tabla 31. Caractersticas del acople eje-manzana.

6.4.6

Buje entre manzana y eje

Permite centrar el eje dentro de la manzana. Ver figura 118.

192

Figuras 120. Representacin el SolidWorks y Fotografa de uno de los bujes.

CARACTERSTICAS
Material: Nylon
Carga Aplicada: 30 Kg.

Tabla 32. Caractersticas buje Eje-Manzana.

193

6.4.7

Rueda de bicicleta

Se seleccion la rueda de bicicleta ms pequea que se encontr en el


mercado, Rin 12. Ver figura 119.

Figura 121. Representacin el SolidWorks y Fotografa de una de las Ruedas

194

CARACTERSTICAS
Material: Rin de aluminio, Radios de acero,
llantas de caucho con labrado
Dimensiones: 12 Pulgadas de Dimetro

Tabla 33. Caractersticas de las Ruedas

En la figuras 120, se muestra el montaje de la subconjunto de transmisin de


potencia.

Figura 122. Fotografas del montaje del subconjunto, transmisin de potencia.

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.

Figura 123. Fotografa de la estructura tubular que soporta la silla.

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

dispuesto horizontalmente, justo debajo de la silla, se acopla a los tubos por


medio de tornillos pasantes.

196

6.6 ENSAMBLE COMPLETO DEL VEAU


La figura 122 se observa, el prototipo ensamblado, con cada una de las partes
antes analizadas, con sus sistemas electrnicos, y sus sistemas de mando,
este es el modelo final.

Figura 124. Ensamble del prototipo de vehculo autobalanceado VEAU

197

SISTEMA DE CONTROL

Este captulo explica cmo se implemento el sistema de control embebido para


el VEAU, que encierra, caractersticas, funciones de la tarjeta y sus
fundamentos operativos, adems se detalla cmo se realizo la organizacin del
cdigo fuente del controlador, una descripcin breve de cmo se integran el
hardware y software es decir, el controlador con los sensores y actuadores por
medio del software, se explica la sintaxis del lenguaje de programacin de alto
nivel Arduino y que funciones se utilizaron.
7.1

SISTEMA DE CONTROL EMBEBIDO

Se conoce como sistema embebido a un circuito electrnico computarizado que


est diseado para cumplir una funcin especfica en un producto.
La inteligencia artificial, secuencias y algoritmos de un sistema embebido,
estn residentes en la memoria de una pequea computadora denominada
microcontrolador10.

7.1.1 CARACTERSTICAS

Los sistemas embebidos son diseados para una aplicacin especfica,


es decir, estos sistemas realizan un grupo de funciones previamente
definidas y una vez el sistema es diseado, no se puede cambiar su
funcionalidad. Por ejemplo, el control de un ascensor siempre realizar
las mismas acciones durante su vida til.

10

GALEANO, Gustavo. Programacin de sistemas embebidos en C. Colombia. 2009, pg. 3.

198

Debido a su interaccin con el entorno los ES deben cumplir


estrictamente restricciones temporales. El trmino Sistemas de Tiempo
Real es utilizado para enfatizar este aspecto.

Los Sistemas Embebidos son heterogneos, es decir, estn compuestos


por componentes Hardware y Software. Los componentes Hardware,
como ASICs y Dispositivos Lgicos Programables (PLD) proporcionan la
velocidad de ejecucin y el consumo de potencia necesarios en algunas
aplicaciones.

Los Sistemas Embebidos tienen grandes requerimientos en trminos de


confiabilidad.

Errores

en

aplicaciones

como

la

aviacin

el

automovilismo, pueden tener consecuencias desastrosas.

En el presente proyecto se trabaj con sistemas embebidos digitales, utilizando


microcontroladores programados en C++, la funcin de este sistema embebido
es la de estabilizar el VEAU un sistema dinmico de naturaleza inestable, los
sistemas embebidos son sistemas que permiten obtener datos por medio de
digitalizacin

de

seales

anlogas,

realizan

operaciones

realizan

conversiones de digitales anlogas para interactuar con el ambiente.


7.2

MICROCONTROLADOR

Un microcontrolador es un circuito integrado o chip que incluye en su interior


las tres unidades funcionales de una computadora: unidad central de
procesamiento, memoria y unidades de E/S (entrada/salida), la mayora de
microcontroladores poseen la estructura bsica que se observa en la figura().

199

Figura 125. Estructura bsica de los microcontroladores.


Fuente: www.ucontrol.com.ar/wiki

Son diseados para reducir el costo econmico y el consumo de energa de un


sistema en particular. Por eso el tamao de la unidad central de procesamiento,
la cantidad de memoria y los perifricos incluidos dependern de la aplicacin.

Un microcontrolador tpico tendr un generador de reloj integrado y una


pequea cantidad de memoria RAM y ROM/EPROM/EEPROM/FLASH,
significando que para hacerlo funcionar, todo lo que se necesita son unos
pocos programas de control. Los microcontroladores disponen generalmente
de una gran variedad de dispositivos de entrada/salida, como convertidores de
analgico a digital(ADC), temporizadores, UARTs (Universal Asynchronous
Receiver-Transmitter) y buses de interfaz serie especializados, como I2C
(Circuitos Inter-Integrados), CAN (Controller Area Network) y SPI(serial
peripherical interface). Frecuentemente, estos dispositivos integrados pueden
ser controlados por instrucciones de procesadores especializados. Los
modernos microcontroladores frecuentemente disponen de una interfaz de
programacin integrada IDE (Integrated Drive Electronics), como el BASIC, C,
C++ o java que se utilizan bastante con este propsito11.

11

http://es.wikipedia.org/wiki/Microcontrolador

200

7.2.1

MICROCONTROLADOR ATMEGA 1280 DE ATMEL

Como se defini en un principio en los objetivos del proyecto de grado la


utilizacin de una tarjeta de desarrollo basada en microcontroladores Atmega,
Se decidi utilizar la tarjeta de desarrollo Arduino mega que integra un
microcontrolador Atmega 1280 de la familia Atmel. Los cuales tienen las
siguientes caractersticas tcnicas de operacin:

Memoria 128 KB (flash)


Memoria 8 KB (SRAM)
4096 bytes de EEPROM.
16 pines (A/D) con un convertidor de 10 bits.
4 canales de PWM de 8 bits.
6 a 12 canales PWM programables a una resolucin entre 2 a 16 bits.
2 a 4 puertos programables de comunicacin USART.
Comunicacin serial SPI.
Rango de temperatura de funcionamiento de -40C a +105C.
Ciclos de borrado y escritura 10.000 flash y 100.000 EEPROM.
Voltaje de alimentacin 2.7 a 5.5 Voltios.
Encapsulado de 100 pines CBGA.

En el Anexo B, se presenta el datasheet (hoja de datos) de el microntrolador


utilizado, en este podemos ver la asignacin de pines para los encapsulados,
as como las caractersticas trmicas, elctricas y planos del microntrolador
Atmega 1280.

En el presente proyecto se utiliz la tarjeta de desarrollo Arduino mega que


integra el microcontrolador Atmega 1280, con los dispositivos necesarios para
su operacin, haciendo ms fcil la aplicacin del microcontrolador en el
proyecto, dado que esta tarjeta fue diseada y construida junto con su software
201

en el cual se incluyeron gran cantidad de libreras que permiten la utilizar el


microntrolador Atmega 1280 con una programacin de alto nivel basado en
C++, pero mucho ms sencilla que la programacin de bajo nivel que debe
manejarse para poder utilizar las prestaciones del microcontrolador Atmega
1280.

Tarjeta de desarrollo Arduino mega.

Tambin llamada placa de desarrollo, creada por el instituto de diseo


interactivo de Ivrea en Italia, integrando los conocimientos de un grupo de
diseadores, ingenieros y artistas, con la idea de aportar un microcontrolador
con plataforma de software y hardware abierto.

Esta

placa

permite

crear

objetos

fsico

interactivos

utilizando

un

microcontrolador de bajo costo, con una programacin de alto nivel.

En nuestro caso la placa de desarrollo Arduino mega integra nuestro


microcontrolador Atmega 1280, para el diseo del sistema embebido de control
del VEAU, el Arduino permite observar las siguientes caractersticas generales
tiene 54 entradas/salidas digitales de las cuales 14 proporcionan salida PWM,
16 entradas analgicas, 4 UARTS (puertos serie por hardware), un cristal
oscilador de 16MHz, conexin USB, entrada de corriente, conector ICSP y
botn de reset.
Contiene todo lo necesario para hacer funcionar el microcontrolador;
simplemente conectndolo al ordenador con el cable USB o alimentndolo con
una batera.
La figura 124, permite observar la placa Arduino en vista superior donde se
pueden observar todos los circuitos y dispositivos que integra esta placa para el
correcto funcionamiento del microcontrolador.

202

Figura 126. Placa de desarrollo Arduino mega.


Fuente: www.arduino.cc/es/Main/ArduinoBoardMega

7.2.2

Caractersticas del Arduino

7.2.2.1 Alimentacin de la placa Arduino MEGA


El Arduino Mega puede ser alimentado por medio de la conexin USB, tambin
permite alimentarse con una fuente externa, esto para cuando se requiere dejar
el Arduino independiente del computador en alguna aplicacin, luego de
programar el microcontrolador. El Arduino mega selecciona automticamente el
origen de la alimentacin.
Las fuentes de alimentacin externas pueden ser, transformador o batera. El
transformador se puede conectar usando un conector macho de 2.1 mm con
centro positivo en el conector hembra de la placa. La figura 125 muestra este
conector. Los cables de la batera pueden conectarse a los pines Gnd y Vin en
los conectores de alimentacin (POWER), que se encuentran en la parte
inferior izquierda de la placa.

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

La placa trabaja con alimentacin externa de 6 a 20 voltios. Si el voltaje


suministrado es inferior a 7V, el pin de 5V del Arduino que se utiliza para
suministrar voltaje a otros circuitos conectados a la placa, puede suministrar
menos de 5 Voltios y la placa puede volverse inestable en cuanto a
funcionamiento, si se usan mas de 12V los reguladores de voltaje se pueden
sobrecalentar y daar la placa. Se recomienda que la placa este alimentada
entre 7 y 12 V.
En la placa encontraremos los siguientes pines de alimentacin:
VIN. La entrada de voltaje a la placa Arduino cuando se est usando una
fuente externa de alimentacin
5V. pin de alimentacin desde el Arduino a otros dispositivos, este pin
posee un regulador de 5 voltios que permite la entrega de este voltaje
independiente de la alimentacin externa que tenga el Arduino.
3V3. Pin de alimentacin desde el Arduino para dispositivos que
requieran de alimentacin de 3.3 volts, la mayora de sensores se
alimentan con 3.3 volts por lo que este voltaje es muy necesario, estos
3.3 V son generados en el chip FTDI de comunicacin de la placa. La
corriente mxima que puede extraerse es de 50mA.
GND. Pines tierra.

204

7.2.2.2 Memoria de la placa


El ATmega1280 tiene 128KB de memoria flash para almacenar cdigo en la
placa Arduino ,4KB son usados para el arranque del sistema o para la IDE del
Arduino. Tiene 8 KB de memoria SRAM y 4KB de EEPROM.
7.2.2.3 Entradas y salidas
El Arduino mega dispone de 54 pines digitales que pueden utilizarse como
entradas o como salidas. Las E/S operan entre 0 y 5 voltios. Cada pin puede
proporcionar o recibir una corriente mxima de 40mA.
7.2.2.4 Pines especializados
Algunos pines son utilizados para recibir (RX) y transmitir (TX) datos a travs
del puerto serie TTL, estos se conectan a los pines del FTDI-USB, un
dispositivo usado para realizar la comunicacin con el PC, de esta forma se
pueden cargar los programas y se podrn visualizar datos que sean enviados
por el Arduino.
Serie: 0 (RX0) y 1 (TX0).
Serie 1: 19 (RX1) y 18 (TX1);
Serie 2: 17 (RX2) y 16 (TX2)
Serie 3: 15 (RX3) y 14 (TX3).
Interrupciones Externas. La placa Arduino mega dispone de 4 pines para
realizar interrupciones externas, estas interrupciones se disparan cuando en
algn pin para este fin llega una seal disparadora de la interrupcin, el
programa que se estara ejecutando se detendra e ira a una funcin que
indica la interrupcin para realizar otra actividad, apenas termine de hacer esta
actividad el programa sigue su curso normal, se deben utilizar algunas libreras
que permite utilizar la funcin attachInterrupt() para el uso de la interrupciones
externas.

205

Pin 18 (interrupcin 5).


Pin 19 (interrupcin 4).
Pin 20 (interrupcin 3).
Pin 21 (interrupcin 2).

Pines PWM: de 2 a 13. Proporciona una salida PWM (modulacin ancho de


pulsos) de 8 bits de resolucin (valores de 0 a 255) a travs de la funcin
analogWrite (). Las seales de pwm del Arduino simulan una seal analgica
de salida de baja resolucin.
Pines de comunicacin SPI. Estos pines permiten realizar comunicacin serial
SPI, un protocolo de comunicacin serial muy usado entre Arduino y otros
dispositivos

electrnicos

como

sensores,

memorias

EEPROM,

microcontroladores, potencimetros, etc. Los pines que dispone el Arduino


mega son:
Pin 50 (SS Slave Select).
Pin 51 (MOSI master output-salve input).
Pin 52 (MISO master input-Slave output).
Pin 53 (SCK Select clock).
Arduino dispone de hardware para esta comunicacin, pero inicialmente no
dispona de software ni de funciones para realizar fcilmente este tipo de
comunicacin, debido al amplio grupo de aficionados al Arduino y a su
comunidad colectiva, actualmente se cuenta con una librera para este tipo de
comunicacin (SPI) en la que se activan cada uno de los pines de
comunicacin, se pide transferencia de datos, permite disparar el clock y
seleccionar el dispositivo esclavo a utilizar siendo el Arduino el mster.
7.2.2.5 Entradas analgicas
El Arduino Mega cuenta con 16 entradas analgicas, y cada una de ellas
proporciona una resolucin de 10bits (1024 valores). Por defecto se mide de

206

tierra a 5 voltios, aunque es posible cambiar la cota superior de este rango


usando el pin AREF y la funcin analogReference().
Comunicacin I2C. Soporte del protocolo de comunicaciones I2C (TWI) usando
la librera Wire.
Pines 20 (SDA).
Pines 21 (SCL).
AREF. Voltaje de referencia para las entradas analgicas. Usado para
disminuir el rango de voltaje de lectura de las entradas analgicas eso permite
tener mayor resolucin en la lectura de manera que podamos optimizar el ADC,
del Arduino, este cambio de voltaje de referencia lo hacemos utilizando una
funcin de Arduino llamada analogReference (type).
Reset. Suministrar un valor LOW (0V) para reiniciar el microcontrolador.

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

7.2.2.7 Esquemtico del controlador


La tarjeta Arduino dispone de un microcontrolador Atmega 1280, el cual integra
todos los dispositivos necesarios para su correcto funcionamiento, por tanto
con respecto a los micro controladores convencionales la tarjeta Arduino se
ahorro la tarea de realizar las conexiones de los dispositivos para el
funcionamiento del microcontrolador, una caracterstica importante es que la
tarjeta incluye una modulo crucial en este tipo de sistemas embebidos y es la
programacin o que en el lenguaje ordinario se le llama quemar el controlador,
la tarjeta cuenta con el integrado que comunica el microcontrolador con el PC
para realizar el envi del programa ,envi de datos y recepcin de datos desde
y hacia el microcontrolador respectivamente.
Adema la tarjeta cuenta con conectores de 2 mm, para la fcil conexin a sus
pines de salidas pwm y entradas analgicas, pines de entrada y salida
digitales, alimentacin 3.3 y 5 Voltios, pines de comunicacin y pines para
realizar interrupciones externas, etc. La figura () permite observar un diagrama
esquemtico de la tarjeta Arduino mega donde se visualiza la totalidad de
conexiones al microcontrolador y permite visualizar las conexiones que se
ignoraron en la tarjeta de esta manera se puede manejar a bajo nivel el
microcontrolador

y ver la disposicin de los diferentes elementos que

constituyen el Arduino Mega.

208

Figura 128. Esquemtico y asignacin de pines de la tarjeta Arduino.


Fuente: www.arduino.cc/es/Main/ArduinoBoardMega

7.3

PROGRAMACIN DEL MICROCONTROLADOR

El Arduino Mega se puede programar con el software Arduino, creado


especialmente

para

usuarios

no

expertos

en

programacin

de

microcontroladores, la programacin es de alto nivel, por lo que permite


interactuar fcilmente con el entorno.
El ATmega1280 en el Arduino Mega viene precargado con un gestor de
arranque (bootloader) que permite quemar el microcontrolador sin necesidad
de un programador por hardware externo, en cambio la programacin se hace
por medio del cable USB utilizando un protocolo de comunicacin con la placa
llamado STK500 creado por la comunidad Arduino.

7.3.1

Software ARDUINO

209

Arduino es llamado al software de alto nivel, en donde se programa el


microcontrolador de la placa, este software es una aplicacin hecha en JAVA,
que se basa en el software Processing ,Wiring y AVR-GCC, y otros programas
de cdigo abierto. En la figura 127 se observa el entorno de Arduino.

Figura 129. Entorno del software Arduino. Fuente: los autores

PROCESSING

es un lenguaje de programacin de cdigo abierto es una

excelente herramienta para las personas que desean crear imgenes,

210

animaciones e interacciones. Inicialmente desarrollado para servir como un


cuaderno de bocetos de software y para ensear los fundamentos de la
programacin dentro de un contexto visual, En la actualidad, hay decenas de
miles de estudiantes, artistas, diseadores, investigadores y aficionados que
utilizan Processing como herramienta para el aprendizaje, creacin de
prototipos y produccin.12
AVR-GCC es un lenguaje de programacin que cuenta con libreras elaboradas
para el manejo de toda la familia de microcontroladores de la casa ATMEL,
estos son programas de cdigo abierto que permiten una programacin de alto
nivel, mucha ms sencilla que la utilizada normalmente en la programacin de
microcontroladores.
Segn lo que se trabaj, el software Arduino es un entorno de programacin
muy sencillo, permite utilizacin de funciones y libreras ya escritas por los
creadores de Arduino, adems la comunidad Arduino actualiza libreras y
amplia la potencialidad del microcontrolador que dispone la tarjeta.
Arduino cuenta con funciones preestablecidas que permiten leer seales
analgicas, seales digitales, adems poder generar seales PWM que
simulan seales analgicas de incremento mximo 0.019 volts (resolucin 8
bits) entre 0 y 5 volts, las seales digitales que manejan son entre 0 o 5 Volts,
adems permite realizar interrupciones, realizar comunicacin SPI, entre otras
funciones, un ejemplo de estas se muestran en la tabla 33.

12

http://www.processing.org/.

211

Funcin
Configurar

Sintaxis

Descripcin

pines pinMode(pin_a_configurar, (INPUT Ajusta el pin en salida

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).

Leer seal digital

Lee el estado del pin


digitalRead(pin_a_leer)

digital.
Lee el estado del pin

Leer

una

seal analogRead(pin_a_leer)

analgica

analgico, por medio de


un ADC de 10 bits Esta
lectura est entre 0 y 5
volts.

Tabla 34. Funciones bsica de alto nivel del software Arduino.

Programacin del controlador.


Debido a que se tiene una planta dinmicamente inestable, se requiere
implementar un sistema de control, que pueda volver estable el sistema, se
implemento es un control de lazo cerrado muy conocido, llamado regulador PD,
observando la figura 128, se observa un diagrama bsico del un sistema de
control de lazo cerrado utilizando un regulador PD. Para la realizar este control
debemos programar el microcontrolador aplicando la teora estudiada sobre el
control de un sistema autobalanceado; en el actual capitulo se explica el
proceso de programacin controlador.

212

Figura 130. Sistema de control de lazo cerrado bsico, con las funciones de cada bloque que lo compone.

Para realizar el control del sistema, se debi realizar un proceso ordenado en el


cual se llamen funciones de usuario consecutivamente, de esta forma se puede
llevar una programacin mas legible, realizando un excelente sistema de
control embebido.

7.3.2

Funciones implicadas en el control

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

Para la programacin de la tarjeta y el respectivo desarrollo algoritmo de


control, se declararon las libreras necesarias para realizar el programa y
utilizar las respectivas funciones que estas permiten, aunque Arduino dispone
infinidad de libreras para funciones propias del lenguaje arduino, que no son

213

necesarias declarar, ya que a bajo nivel estas ya estn incluidas, para


aplicaciones ms avanzadas debemos incluir la librera respectiva para
trabajar.

Librera Spi.h: Debido a que se realizo comunicacin SPI (serial peripherical


interface) para la comunicacin con el sensor de inclinacin utilizado
(ADIS16203) [1] debemos incluir esta librera en el programa principal, esta es
una librera realizada por la comunidad Arduino, que configura los pines del
controlador ATMEGA 1280, para realizar la comunicacin, definiendo los pines
MISO, MOSI, CS, SCLK que son los pines necesarios para realizar este tipo de
comunicacin.

7.3.2.2.

Declaracin de variables: en C++

La declaracin de variables es una parte importante de este lenguaje de


programacin, ya que en esta declaracin se permite definir el tipo de dato que
define el espacio de memoria que le corresponde a cada variable.
En el programa se declaran diferentes tipos de datos, entre estos datos
utilizados en el programa se encuentran:
Registros: Tipos de datos utilizados para realizar comunicacin con otros
dispositivos, se escriben en base hexadecimal.

Constantes: Tipos de datos que permanecern invariantes en el


programa,

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

numrico realizara operaciones tan rpido como lo permita el tipo de


dato, es decir a mayor precisin en el dato a operar, mayor tiempo de
procesamiento del ordenador, o en este caso el microcontrolador.

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.

Figura 131. Caracterizacin de pines del Arduino Mega.

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

explcitamente como entradas con la funcin

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.

Inicializar la comunicacin serial

Cuando se requieren ver datos en el PC desde el Arduino, como ejemplo datos


de algn sensor que se lee, necesitamos realizar comunicacin serial con el
Arduino, esta comunicacin se inicializa con la funcin Serial.begin (baudios de
transmisin), la velocidad de transmisin de datos se configura junto con el
puerto del USB del computador al cual est conectado el Arduino, normalmente
se configura a 9600 bits/segundo.
7.3.2.5.

Estructura del programa

La programacin del microcontrolador, se realiz utilizando funciones de


usuario llamadas dentro del programa principal de manera secuencial y
ordenada, se describen las funciones utilizadas en el algoritmo de control
implementado para la estabilizacin del vehculo autobalanceado VEAU.

13

http://www.arduino.cc/en/Reference/PinMode.

216

7.3.2.6.

Funcin (VOID) SETUP

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

Esta funcin significa, variable de proceso acelermetro, obtiene el valor


entregado por el inclinmetro, realiza un filtro digital por medio del llamado de
la funcin readRegister (registro) funcin utilizada para la comunicacin SPI,
adems realiza un filtro digital para la eliminacin de ruido y devuelve el valor
de inclinacin filtrado y real.
7.3.2.8.

Funcin READREGISTER

Debido a que el inclinmetro ADIS16203 [1] es un sensor con interfaz digital,


debe ser comunicado utilizando comunicacin serial (SPI) (ver anexo A donde
se describe detalladamente este inclinmetro), se escribi la funcin
readRegister() que permite leer una palabra de 13 bits, que luego es convertida
a decimal en coma flotante y es multiplicada por la constante de conversin,
obteniendo el ngulo en grados, esta funcin se desarrollo de acuerdo con el
datasheet del ADIS16203 que se encuentra en el Anexo A.
La comunicacin SPI se encuentra en el anexo D, donde se explica con ms
detalle su configuracin, cada funcin y el respectivo cdigo.

217

7.3.2.9.

Funcin WRITEREGISTER

Esta funcin tiene el objetivo de enviar los comandos al inclinmetro para


realizar la configuracin de la comunicacin SPI, como su nombre lo dice
escribe los registros de manera sincronizada, para poder decirle al inclinmetro
que nos envi datos.

7.3.2.10. Funcin P_VG

Esta funcin significa variable de proceso giroscopio, lee el valor de la entrada


analgica donde se encuentra conectado el giroscopio IDG 500 de invensense,
devuelve un valor float de velocidad angular en grados por segundo.
7.3.2.11. Funcin CAL_ANGLE

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

Figura 132. Filtro implementado para la obtencin del ngulo real.

La ecuacin que se implemento en el clculo del filtro, se divide en tres partes:


Integracin: se integra la velocidad angular suministrada por el
giroscopio, como se sabe la integracin numrica acumula errores
debido a un valor no nulo de velocidad angular en reposo, dando una
lectura de ngulo errnea, este fenmeno se llama drift. El drift ocurre
para periodos cortos de tiempo, es decir el drift no se presenta a largo
plazo, para cambios de movimiento rpidos o a frecuencias altas, el
giroscopio permite obtener un valor de ngulo muy preciso y el drift no
se presenta, es por eso que se dice que el giroscopio permite el clculo
del ngulo para cuando el vehculo esta en movimiento.

Filtro pasa baja: El filtro se aplico a la lectura del acelermetro, como se


sabe este sensor incluye mucho ruido, debido a que este censa
aceleraciones es fcilmente perturbado por aceleraciones externas
lineales que no nos permiten obtener un valor de ngulo preciso, debido
a que se cuenta con un inclinmetro digital para la lectura de ngulo este
proceso se har, debido a que se quiso filtrar cambios de inclinacin
muy bruscos a altas frecuencias, este filtro atena frecuencias altas y
permite obtener un valor de ngulo a largo plazo que puede ser

219

necesario cuando el vehculo se encuentra en el estado esttico, donde


no hay mucho movimiento.

Complementacin de los filtros: ya que se utilizo un filtro pasa alta y


pasa baja, se complementa informacin de nuestra variable y por lo
tanto no se pierde informacin, aunque lo anterior es una aproximacin,
esto puede ser muy cercano a la realidad debido a que el tiempo de
muestreo es mucho menor que la constante de tiempo del sistema.

La ecuacin que permiti obtener la integracin y el clculo de los filtros es:

Integracin

Filtro pasa bajas

Filtro pasa altas

Luego de haber hallado el ngulo preciso, se realizo la accin de control PD


que se muestra siguiente ecuacin:

Este valor es suministrado a cada motor derecho e izquierdo respectivamente,


adems la funcin Calc_angle (float, float) permite realizar la operacin de giro
llamado normalmente steering del vehculo, por medio de una variable dada por
un potencimetro que comanda la rotacin. La funcin permite evitar la
saturacin de accin de control, cuando llegue al valor mximo esta se acota, y

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.

7.3.2.12. Funciones de interrupcin

Normalmente se le llama ISR (rutina de servicio a la interrupcin), esta funcin


es llamada 110 veces por segundo o segn el tiempo que se ha programado el
TIMER de la interrupcin, esta funcin llama las funciones P_Va(), P_Vg() y
Cal_angle().
En el anexo C se encuentra la totalidad del cdigo implementado con los
comentarios que especifican cada una de las lneas de cdigo.
En figura 131 se observa el diagrama de flujo se puede observar la secuencia
del algoritmo de control implementado.

En la tabla 35 se resumen las funciones usadas para el desarrollo del programa


y se mencionan sus principales caractersticas.
NOMBRE

SINTAXIS

DESCRIPCIN

setup

Void setup
()

Funcin bsica de programa


principal, es tambin llamada en
C++ como el int main(), aqu se
definen e inicializan variables y
modo de pines.

loop

Void loop ()

Funcin bsica en la programacin,


de microcontroladores, realiza la
funcin de un bucle while infinito,
que permite actualizar valores de
las variables de los sensores, y
variables de control.

221

PARMETRO DE
ENTRADA
Ninguno

RETORNA

Ninguno

Ninguno

Ninguno

Incli

Float
Incli()

funcin de usuario creada para la


lectura del inclinmetro, Incli
significa inclinacin, el valor del
ngulo entregado por el
inclinmetro, se obtiene por medio
de las funciones creadas para
realizar la comunicacin SPI que se
explican en el anexo D.

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)

Su nombre P_Va significa variable


del proceso acelermetro, esta
funcin permite realizar un filtrado
digital al valor entregado por el
inclinmetro, debido, a que este
sensor presenta un ruido
considerable en su lectura.
Su nombre P_Vg significa variable
de proceso giroscopio, esta funcin
permite leer el valor analgico de
velocidad angular y realiza un
filtrado digital para la eliminacin de
ruido, que suministra el giroscopio
conectado a una entrada analgica
del microcontrolador.
Su nombre Calc_angle significa
clculo del ngulo, esta funcin
permite tomar el valor de ngulo y
velocidad angular, los integra
creando una unidad de medicin
inercial, por medio de un filtro pasa
alta y pasa baja digital (ver captulo
7.3.3.5), el resultado de esta
funcin es el clculo exacto de
ngulo, adems implementa un
regulador PD que entrega la seal
de control a los motores, por medio
de la funcin analogWrite esta
funcin entrega un seal de PWM al
puente H que maneja los motores.
Funcin llamada ISR(rutina de
servicio a la interrupcin), es una
funcin que siempre est presente,
cuando se utilicen interrupciones
internas en cualquier
microcontrolador, es llamada
peridicamente segn se defina
algunos registros de TIMERS, este
periodo que se configura se
mantiene constante(ver captulo
7.4.1). Dentro de esta funcin se
llaman las funciones P_Va, P_Vg y
Calc_angle, la idea de cualquier
control digital es mantener el tiempo
de muestreo constante, eso es lo
que se produce cuando se hacen
interrupciones, se esta manera para
nuestra interrupcin actuamos 110
veces por segundo sobre los
motores.
Tabla 35 Resumen de funciones.

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.

CONTROL POR INTERRUPCIONES

Para el desarrollo del sistema de control implementado en el vehculo, se aplico


la tcnica de control por interrupciones, esto es aplicable para sistemas en los
que la constante de tiempo es muy baja, o en otras palabras para sistemas que
cambian su estado dinmico a alta velocidad, o sistemas dinmicamente
inestables.
Adems en el control por interrupciones se tiene la certeza de realizar
actividades de control, en tiempos establecidos fijos, sin importar que pueda
pasar dentro del ciclo infinito donde corre el programa, un ejemplo de lo que
puede pasar si no se realiza un control por interrupciones es debido a una
operacin muy compleja dentro del programa principal, este consume ms
tiempo y capacidad de procesamiento, dejando al programa atendiendo esta
operacin, abandonando la actualizacin de datos y dejando de actuar sobre el
sistema , esto se traduce en dejar el sistema sin control.
La figura 132 muestra un esquema de un control sin interrupciones, se observa
el algoritmo de control, pueden aparecer operaciones que consuman mucho
tiempo , interrumpiendo el flujo normal de datos, en este caso como no termina
esta operacin, la actualizacin de datos de salida o acciones de control sobre
el sistema son interrumpidos y el sistema queda sin control, si se tiene la
certeza de que el programa jams tendr retardos, el sistema podra correr y
funcionar correctamente, actualizando datos a la salida.

223

Figura 133. Diagrama de bloques de la estructura del algoritmo de control implementado

224

Figura 134. Control sin interrupciones.

Figura 135. Control con interrupciones

Lo contrario pasa con el control por interrupciones, en la figura 133 se ve cmo


funciona este proceso, el programa corre normalmente, entra en el ciclo infinito,

225

realizando

las

operaciones

correspondiente

estando

pendiente

del

desbordamiento del TIMER de interrupcin, apenas se desborde el timer que


normalmente se configura en un tiempo base o fijo, este llama a una funcin
llamada ISR (routine service of interrupt), en esta funcin se encuentran todas
las actividades que se necesitan para realizar el control, actualizacin de
variables de los sensores, algoritmo de control, y actualizacin de datos a la
salida a los actuadores, apenas termine esto, salta a la lnea de cdigo dentro
del ciclo infinito donde inicialmente estaba, esperando de nuevo el
desbordamiento del timer.
De esta forma a pesar de que una operacin pueda durar mucho tiempo se
mantiene el sistema actualizado, y el control no es interrumpido.
Este tipo de control permite, tener un tiempo de muestreo constante, necesario
para realizar control PID mucho ms preciso, ya que el tiempo de integracin y
el derivativo son constantes.

7.4.2. Programacin de la interrupcin

Para realizar la interrupcin debe primero seleccionarse el tipo de interrupcin


ya que existen diferentes tipos de interrupciones en nuestro caso realizaremos
interrupciones por desbordamiento del timer.
Los temporizadores en Arduino son de 8 bits o algunos de 16 bits que se
incrementan a intervalos de tiempo especficos. Cuando el contador est en su
valor mximo (255 para el temporizador de 8 bits y 65535 para el temporizador
de 16 bits) y se incrementa de nuevo, se dice que se ha desbordado el TIMER,
ahora al desbordarse de da la interrupcin, llevando el programa a una funcin
llamada ISR que atiende la interrupcin.
Arduino tiene un reloj que funciona a una velocidad de 16Mhz, es decir, hay un
pulso de reloj de 16 millones de veces por segundo. En cada pulso de reloj, el
contador del temporizador se incrementa, lo que significa que cada 256

226

impulsos de reloj del contador de 8 bits se desborda, se genera una


interrupcin y el controlador de interrupcin se ejecuta.
El equipo responsable de los temporizadores en el Arduino contiene un mdulo
ingenioso llamado preescaler: Este preescaler divide la seal del reloj
disponible en un 8, 64, 256 o 1024. Con el preescaler fijo en 8, el temporizador
no se aument 16 millones de veces por segundo, ahora se aumentara
16.000.000 / 8 = 2 millones de veces por segundo. , por lo tanto ya el
temporizador no se desbordara tan pronto. Lo que se hace es bajar la
frecuencia del clock ahora con un preescaler de 8 no es de 16MHz sino de 2
MHz, el desbordamiento slo ocurren con una frecuencia de 2 MHz / 256 =
7.8KHz.

Usando el temporizador de 16 bits (Timer1), slo se desborda cada 65.536


impulsos de reloj y con el preescaler establecido en 1024, la frecuencia ms
baja posible para el contador de tiempo de interrupcin es:

Para un temporizador de 16 bits, y un preescaler de 1024, tenemos:

Para la programacin e la interrupcin nos referimos al datasheet del


microcontrolador, en el anexo B se encuentra el datasheet del microcontrolador

227

que dispone la tarjeta, primero buscamos los vectores de interrupcin, en el


captulo correspondiente a esta parte, luego de seleccionar el timer contador ,
nos referimos a los registros para configurar solo caractersticas bsicas, tales
como:
Bits de habilitacin de interrupciones por desbordamiento.
Bits para configurar el modo de operacin del timer contador.
Bits para configurar el valor inicial del contador.
Bits para configuracin del preescaler.

Estos bits se colocan en hexadecimal, podemos con esto poder configurar el


TIMER de manera que se pueda realizar interrupciones en el tiempo que es
requerido.
En el anexo C se encuentra el cdigo donde se encuentra la configuracin de
los registros del Timer contador 2, para realizar interrupciones 100 veces por
segundo.

7.5.

COMUNICACIN SPI

Es un bus de tres lneas, sobre el cual se transmiten paquetes de informacin


de 8 bits. Cada una de estas tres lneas porta la informacin entre los
diferentes dispositivos conectados al bus. Cada dispositivo conectado al bus
puede actuar como transmisor y receptor al mismo tiempo, por lo que este tipo
de comunicacin serial es full dplex. Dos de estas lneas trasfieren los datos
(una en cada direccin) y la tercer lnea es la del reloj. Algunos dispositivos
solo pueden ser transmisores y otros solo receptores, generalmente un
dispositivo que tramite datos tambin puede recibir.
Los dispositivos conectados al bus son definidos como maestros y esclavos.
Un maestro es aquel que inicia la transferencia de informacin sobre el bus y
genera las seales de reloj y control.

228

7.5.2.

Especificaciones del BUS

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.

Figura 136. Esquema de comunicacin SPI mltiple.

En nuestro caso la comunicacin se hizo entre el microcontrolador y el


inclinmetro digital, la secuencia de la comunicacin es:
Enviar la direccin de registro con el comando de lectura o escritura (R o W), si
es para Write el comando es 0-0, si es para Read es 1-0, el registro es una

229

palabra de 6 bits, este registro me indica la direccin de memoria del


inclinmetro donde se encuentra los datos.
Segn la figura 135 podemos ver el orden de envi de los bits, primero 1 0
sin quiere escribir o leer respectivamente, luego un tren de 6 bits A5, A4, A3,
A2, A1, A0, los dos primeros bits y los otros 6 bits completan un byte.
Cuando se envan los bits como escritura, por el mismo serial el inclinmetro
enva los datos de inclinacin correspondiente, en trenes de 8 bits, los cuales
debemos esperar los primeros 8 bits LSB y luego los 8 bits MSB, de esta
forma se realiza la comunicacin SPI, algo que es vital en la comunicacin es
el serial clock es una referencia para sincronizar los dos dispositivos como se
ve en la figura 135 por cada flanco de subida se enva un bit, tambin el Chip
select es una referencia para empezar la comunicacin SPI cuando este pasa
de alto a bajo.

Figura 137, envi de datos del microcontrolador al inclinmetro

230

Figura 138. Esquema de comunicacin entre Arduino y inclinmetro.

En el anexo C, se encuentra el cdigo programado para la lectura del


inclinmetro digital ADIS16203, los comentarios de cmo funciona son muy
explcitos.

231

8.

PRUEBAS

A lo largo de la etapa de aprendizaje del manejo del Arduino, etapa de potencia


sensores y dems componentes de este proyecto, se realizaron diferentes
pruebas con varios dispositivos que funcionan de forma similar al VEAU, los
cuales de describirn a continuacin.

8.3.

MODELO DE PRUEBAS 1

Carrito de balso: Por medio de este vehculo se realiz el primer intento de


control. Se implemento un control ON OFF y un proporcional. La prueba
consisti en mantener vertical un listn de madera, el cual pivotaba en un
potencimetro corriente, el cual a su vez hacia el papel de sensor de
inclinacin, a travs del movimiento en lnea recta del carrito de balso. Este se
propulsaba gracias un par de motores pequeos los cuales venan acoplados a
un juego de reductores planetarios plsticos. Controlador, Arduino MEGA.
Etapa de potencia, Puente H, integrado L298N montado en Protoboard.
Alimentacin, fuente de computador.
En la figura 137 se observa la estructura del vehculo con el potencimetro en
la parte superior.
La figura 138 se observa el ensamble total del modelo de pruebas 1,el vehculo
con el listn de madera, este indicaba cuando el vehculo deba avanzar o
retroceder, de manera que sostuviera el listn en su posicin vertical.

232

Figura 139. Modelo de pruebas 1, carrito de balso.

Figura 140. Fotografas del modelo de pruebas 1, ensamble total.

Comentarios y resultados de la prueba:


Motores muy pequeos.
Mtodo de control muy bsico ON OFF y proporcional.
No se obtuvo control, ms si se observ un movimiento alrededor del
Setpoint mientras se sostena el listn con la mano.
Se obtuvieron las primeras experiencias con el controlador respecto
software de programacin y manejo de hardware, se observo la buena
233

velocidad de actuacin del microcontrolador. Se adquirieron nuevos


conocimientos en cuanto a la ingeniera de control aplicada.

8.4.

MODELO DE PRUEBAS 2

Carrito de juguete: Se realiz un montaje similar al anterior (los mismos


componentes electrnicos) usando un carrito de juguete como estructura, se
puede observar en la figura 139. A diferencia del anterior, este cuenta con
motores un poco ms grandes lo que permite una mejor respuesta. Se
implemento un control PD.

Figura 141. Fotografa del modelo de pruebas 2.

Comentarios y resultados de la prueba:


Al tener motores ms grandes la respuesta dinmica del sistema fue mejor
aunque estos presentaban mayor juego (o backlash) en sus engranajes.
Se implemento un algoritmo de control PD ms elaborado que en el caso
anterior logrando una estabilizacin por algunos segundos.

234

Al utilizar como sensor un potencimetro, tambin introduce menos precisin


en el control del sistema dinmico, ya que este oscilaba alrededor del setpoint
ngulos muy pequeos.

8.5.

MODELO DE PRUEBAS 3

Pndulo invertido: Se us la estructura de un plotter, siendo el carro de


cartuchos la base en la que se fijo el potencimetro, que se uso como sensor
de inclinacin. Los elementos electrnicos fueron los mismos que se usaron en
las pruebas anteriores (ver figura 140). Se implemento un algoritmo de control
PID.

Figura 142. Fotografas del modelo de pruebas 3, pndulo invertido.

235

Comentarios y resultados de la prueba:


Este montaje cuenta con un motor de alta respuesta dinmica y cero backlash.
A pesar de ser muy econmico, el potencimetro entrega una seal poco
ruidosa, la cual mejorara si se utilizara un encoder incremental, que no se
implemento debido al tiempo de mquina que consume hacer la codificacin de
las seales que entrega el encoder.
Se implement un lazo de control de verticalidad ms no de posicin en el riel.
Se logro el control del sistema.
Para realizar el control de posicin se debe leer el encoder lineal con el que
cuenta el plotter.

8.6.

MODELO DE PRUEBAS 4

Vehculo Vertical 1: La estructura y distribucin de peso de este vehculo se


asemeja ms al objetivo final del proyecto. Se bas en la disposicin de vertical
de peldaos de madera en los cuales se ubicaron cada una de las partes
electrnica y mecnicas que lo componen, como son: (de abajo hacia arriba)
Ruedas, eje con engranaje para transmisin por correa dentada, moto-reductor
con engranaje acoplado en el eje de salida, etapa de potencia (puente H
basado en el integrado L298N), Arduino, filtros analgicos y en la parte superior
se ubican los sensores, acelermetro y giroscopio, adems de unas pesas que
concentran el centro de gravedad en la parte superior del vehculo.

236

Figura 143. Fotografas del modelo de pruebas 4.

Comentarios y resultados de la prueba:


Se implemento un arreglo de 6 integrados L298N en paralelo para el manejo
de potencia del motor. Por la naturaleza de este integrado, el cual no es ptimo
para trabajar en paralelo, hubo problemas con el mismo, y ocasionalmente se
quemaba alguno de estos. Esto debido a que cuando estos integrados se
calientan aumenta el flujo de corriente a travs de ellos, por lo tanto si se
calienta un integrado ms que los otros por este va a pasar ms corriente,
logrando que ste caliente aun ms, hasta quemarse.
A pesar de que se implement un control PID ms elaborado que en los casos
anteriores, no se logr un control total de sistema debido a que los sensores
(acelermetro y giroscopio) presentaban ruido en su seal de salida, y en ese
momento no se contaba aun con un algoritmo tal que lo disminuyera hasta
valores aceptables para en control. Por lo tanto en la regin central el vehculo
mostr un comportamiento semiestable con algunos picos de corriente en los
motores que desequilibraban el sistema. Luego de que el vehculo sala de la
zona central y este empezaba a desplazarse (inclinado), mostr un
comportamiento mucho ms estable.

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

Figura 144. Fotografas del modelo de pruebas 5

Comentarios y resultados de la prueba:


Se implemento un algoritmo de control mucho ms elaborado que en los casos
anteriores en el cual se hizo un filtro compuesto, este toma las salidas del
acelermetro y giroscopio y obtiene una sola salida con un nivel de ruido
mnimo con el que calcula los trminos del PD.
En la primera prueba se logr un control aceptable en donde el vehculo se
mantiene vertical sin caerse. La prueba dur hasta que se acabo la carga de
las bateras, momento en el cual el controlador empez a fallar pues en los
picos de corriente del motor se cortaba el suministro hacia el arduino, razn por
la cual se opto para las siguientes pruebas por alimentar todos los dispositivos
electrnicos con una batera independiente.

239

En la segunda prueba se obtuvo un comportamiento mejor, se mantuvo vertical


y pudo rotar como se esperaba. El vehculo requera de un pequeo empuje
hacia adelante o hacia atrs para inicial el movimiento en el cual se mantena
casi a velocidad constante.

8.8.

MODELO DE PRUEBAS 6

En esta etapa se quiso hacer un montaje similar al Segway, las bateras se


ubicaron en la parte baja del vehculo, junto con la electrnica, adems se
instal una barra vertical y un manubrio ver figura 143.
Se usaron los mismos componentes que en el modelo anterior, se realizo un
cambio en los motores, por unos de mayor potencia, estos nuevos motores
contaban con la caja reductora metlica dndonos ms confianza para poder
realizar pruebas ms avanzadas. En este modelo de pruebas se programo una
prueba mucho ms seria y compleja, en la que se pensaba subir una persona
de 75 Kg, el vehicul deba estructuralmente poder soportar la carga y respecto
al control poder controlar el vehicul y adems realizar movimientos de
traslacin y rotacin.

240

Figura 145. Fotografas del modelo de pruebas 6.

Figura 146. Fotografas del modelo de pruebas 6, modulo de electrnica.

Comentarios y resultados de la prueba:

241

Inicialmente se verific que el vehculo, se mantuviera en equilibrio, puesto que


al tener el centro de gravedad ms bajo se dificulta el control. Una vez logrado
este objetivo, se realiz la prueba con una persona sobre l, prueba que result
exitosa Ver Figuras 145.
En la prueba se obtuvo estabilizacin del sistema sin pasajero, estabilizacin
del sistema con el pasajero y movimientos controlados de translacin y
rotacin, este ltimo movimiento se controlaba por medio de un potencimetro
de palanca que al girarlo hacia adelante y hacia atrs produca el movimiento
de rotacin en sentido horario o anti horario respectivamente.

Figura 147. . Fotografas de los autores del proyecto, como pasajeros en el modelo de pruebas 6

242

8.9.

MODELO FINAL

En este vehculo se implementaron unos motores de mayor potencia que en


los casos anteriores. De 12 Volt, estos motores requirieron la implementacin
de una etapa de potencia ms elaborada usando los mismos transistores
MOSFET tipo NPN y PNP que en los casos anteriores, pero montados en
paralelo para aumentar su capacidad de manejo de corriente. Esto debido a
que, como la potencia es

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.

Figura 148. Fotografa del modelo final.

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

Vehculo vertical con


peldaos de madera
y parales de
aluminio. Planta de
funcionamiento
similar al del objetivo
de este proyecto.

Modelo Vehculo vertical


de
montado sobre la
Pruebas estructura del VEAU.
5

Modelo Vehculo vertical se


de
montaje similar al
Pruebas Segway.
6

REUMEN DE LAS PRUEBAS

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.

Tabla 36. Resumen de las pruebas

245

se daba la orden para


girar.
Se obtuvo una
respuesta similar al
caso anterior con la
diferencia de que este
vehculo tiene una
mayor respuesta
dinmica debido a la
mayor potencia de
sus motores.

9.

CONCLUSIONES

Se seleccionaron cada unos de los componentes del sistema, como son,


sensores, motores, ruedas, controlador y

bateras entre otros,

por

medio de tablas de seleccin en los casos que lo amerit.


Se dise y construy la estructura, mecanismo de deslizamiento,
acople motor-rueda y barra de direccin utilizando SolidWorks y ANSYS
Workbench como herramienta CAD y CAE respectivamente.
El vehculo desarrollado puede ser utilizado con los mecanismos
implementados para personas que no puedan mantenerse en pie o
estos mecanismos pueden desmontarse fcilmente para utilizarlo de
forma similar al vehculo autobalanceado comercial Segway.
Se desarroll un anlisis para seleccionar una tarjeta basada en el
microcontrolador Atmega 1280, en el cual se tuvo en cuenta sus
caractersticas principales tales como velocidad de reloj, resolucin en
convertidor analgico-digital y modulo PWM, manejo de diferente
protocolos de comunicacin, cantidad de entradas y salidas, facilidad de
programacin, disponibilidad y precio, entre otros .
Se disearon varios algoritmos de control para el sistema, teniendo en
cuenta los sensores usados, pues cada uno de ellos requiri una
programacin especial, ya sea en cuanto a filtrado de las seales
obtenidas o protocolos de comunicacin.
Se dise un algoritmo embebido de control, donde se aplicaron
tcnicas de programacin avanzadas, para la optimizacin del algoritmo
de control, se implement un control PID como tcnica de control,
utilizando interrupciones internas para mantener el tiempo de muestreo
constante siguiendo las teoras que nos ensea la ingeniera de control y
se hizo uso de funciones de usuario para poder construir un cdigo ms
estructurado y ordenado.
Se realiz un estudio detallado de los sensores utilizados en el control
del sistema dinmico, este estudio tuvo como base , principios de
funcionamiento de los sensores, variables relativas de los sensores en
246

cuanto a desempeo y eficiencia, costo, disponibilidad , rango de


medicin y una caracterstica de suma importancia, la sensibilidad, que
permite optimizar el convertidor anlogo digital del microcontrolador,
estos parmetros se tuvieron en cuenta en la seleccin, los sensores
seleccionados como mejor opcin permiti realizar un control preciso
sobre el vehculo.
Dentro de las posibles alternativas de sensores de inclinacin se
seleccionaron un acelermetro MMA7260 y un inclinmetro ADIS16203
por medio de un estudio detallado de sus caractersticas. Con ambos se
obtuvieron resultados satisfactorios de control.
Se

implemento

un

algoritmo

que

compensa

las

aceleraciones

indeseadas obtenidas por el acelermetro, debidas a movimientos del


sistema, con un giroscopio el cual no se afecta por este tipo de
movimientos.
Se desarrollo el modelo matemtico del sistema dinmico, aplicando
herramientas computacionales como Matlab y simulink, se construyo un
modelo de simulacin para analizar aspectos relacionados con el control
del vehculo, implementando un controlador PD, y obteniendo las
constantes de sintonizacin tericas del

sistema, por medio del

poderosa herramienta de Matlab llamada auto tunning que dispone su


librera PID, adems se realizo el anlisis de estabilidad utilizando el
mtodo del ROOTLOCUS, se obtuvo la funcin de transferencia del
sistema, y las matrices de estado para el modelo linealizado.
Se obtuvieron, los requerimientos tcnicos necesarios para el control del
vehculo, por medio de el anlisis de los resultados arrojados por el
modelo matemtico.
Se dise y construy un puente H para regular la potencia enviada a
los motores usando como elementos de switcheo

transistores

MOSFET de hasta 74 A, tipo NPN y PNP montados en un arreglo en


paralelo para lograr el manejo de una mayor potencia. Las entradas de
control de este sistema se aislaron pticamente para evitar daos en el
microcontrolador en caso de alguna falla en la etapa de potencia.

247

Se diseo e implement un sistema lgico a travs de compuertas que


evita que ambas ramas del puente H queden abiertas, descartando la
posibilidad de dao en los transistores por corto. Adems este sistema
facilita la activacin del puente H puesto que para que el motor gire en
un sentido o en otro solo requiere del envo de un UNO o CERO lgicos
independientes de la seal de PWM.
A lo largo del proyecto de utilizaron diferentes tipos de motores para
realizar cada una de las pruebas. Para el prototipo final se seleccionaron
los motores de 12 Volt con reduccin planetaria 16:1 BANEBOTS de 200
W aproximados en pico.
Se realiz el proceso se seleccin, compra e importacin de los
diferentes elementos especiales que este proyecto requiri tales como
motores, sensores y dems elementos electrnicos.
Se verific la alta capacidad de la tarjeta Arduino MEGA, a pesar de su
bajo costo y sencillez en su programacin,

para realizar tareas de

control en un sistema altamente inestable, el cual requiri de una alta


velocidad en, la adquisicin de datos, clculos matemticos y precisin
en los mismos.

248

10.

RECOMENDACIONES

En el presente trabajo de grado se present un prototipo de una


alternativa de transporte para distancias medianas o cortas para
personas con capacidades disminuidas calificadas, el cual a pesar de
que en principio fsico funcion, aun no se puede presentar como un
producto terminado para el uso de tal poblacin, puesto que se trata de
un vehculo altamente inestable y los sistemas de control no son
redundantes, por lo que cualquier falla en la lectura de los sensores o
salida del controlador puede generar una cada.
Se recomienda para futuros proyectos el estudio e implementacin de
mtodos de control ms sofisticados tales como Lgica Fuzzy, Redes
Neuronales o Algoritmos Genticos, para el control de vehculos de este
tipo.
Para el desarrollo de un vehculo de este tipo completamente funcional y
seguro, se recomienda el trabajo en equipo de ingenieros mecnicos,
electrnicos,

biomdicos,

diseadores

industriales

personal

especializado en el manejo de pacientes con capacidades motoras


disminuidas, tales como mdicos o fisioterapeutas.
A pesar de que a la salida de las bateras se ubic un fusible de 40 A se
recomienda la implementacin de un sensor de corriente capaz de
detectar picos altos de corriente en pequeos intervalos de tiempo de tal
forma que se proteja adecuadamente la etapa de potencia.

249

BIBLIOGRAFA

[1] Segway Inc, [en lnea], http://www.segway.com


[2] Grasser, F., DArrigo, A., Colombi, S. y Rufer, A. C, JOE: a mobile, Inverted
Pendulum, IEEE Transactions on Industrial Electronics, Vol. 49, No 1,
2002.
[3] MIT, The DIY Segway [en lnea] http://web.mit.edu/first/segway
[4] Dudash, P., Eakins, G., Geier, E. y Gries, J, The Two Wheel Deal [en
lnea], http://cobweb.ecn.purdue.edu/~477grp12/index.html
[5] Toyota, Toyota Develops Personal Transport Assistance Robot Winglet [en
lnea], http://www.toyota.co.jp/en/news/08/0801_1
[6] MORENO BUSTAMANTE Leonardo

Felipe, Vehculo Autobalanceado

sobre dos Ruedas, Universidad de Chile, junio 2009.


[7] MALVINO Albert Paul, Principios de electrnica, sexta edicin, McGrawHill
1999.
[8] YEVENES Cristian Guajardo, Control de un pndulo invertido, Universidad
Tcnica Federico Santa Mara, mayo 2004.
[9] Analog Devices, Analog Devices: Programmable 360 Inclinometer ADIS1603, http://www.analog.com/UploadedFiles/Data_Sheets/ADIS16203.pdf
[10] International rectifier. IRFZ4905 Datasheet Version 2.01 [en lnea],
http://www.redrok.com/MOSFET_IRF4905_-55V_-74A_20mO_Vth-4.0_TO220.pdf [consulta: 5 de febrero del 2010].

[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],

http://www.st.com/stonline/books/pdf/docs/1773.pdf. [consulta:1 de febrero de


2010].
[13]

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

ANEXO B. DATASHEET DEL MICROCONTROLADOR ATMEGA 1280.

257

258

259

260

261

262

ANEXO C. CODIGO FUENTE DEL CONTROLADOR EN ARDUINO.


#include <avr/interrupt.h>
#include <avr/io.h>
#include <Spi.h>
#define G_OFFSET 285

//offset del gyro

#define scale_GX 289

//factor de escala para el gyro

#define CONS_INCL 0.05

/**************************
***********************/

inicializacion

filtros

/*** Acelerometro ***/


int k=30;
float numa[30];

/*** Giroscopio ***/


int u=5;
float numg[5];

/*********************
inicializacion
comunicacion SPI *********************/

de

registros

para

//Direccion de registro del sensor ADIS16203 segun la tabla 6


pag 13.
const byte READ = 0b00111111;
//Comando de lectura de datos,
se envia una palabra de 8 bits, 6 bits LSB con la direccion de
registro, 2 bits MSB, 0 read, 0 obligatorio
const byte WRITE = 0b10000000;
//Comando de escrira de datos,
se envia una palabra de 8 bits, 6 bits LSB con la direccion de
registro, 2 bits MSB 1 write, 0 obligatorio

/*** contstantes de conversion ***/


float p=2.56/1.023;

/******* parametros basicos de referencia para el control de


inclinacion *********/

263

signed int pwmmax=250; //maximo PWM que se podra sacar a los


motores, define la corriente maxima q suministramos a los
motores
/*** constantes del PID ***/
float Kp=6.5;
float Kd=0;
float Kg=0;
float Kst=0;

/********* inicilaizacion de variables de las banderas(flags)


********/
volatile int un,diez,bal,ADCs=0;

/************** Variables del PID ******************/


volatile float angle,turn,Pvg,Pva,motor,rmotor,lmotor,omega=0;

/*** Variables incializadas a 0 ***/


unsigned int counter=0;

/***************************************************************
****/
float dt=0.010;//averiguar el tiempo de interrupcion real en
segundos.
float a=0.97;

/*********************inicializacion
SPI**********************************************/

var

//Pines a conectar el arduino con el sensor el chip select que


es que da la orden de arrancar la comunicacion SPI , llamada CS.
const int reset=49;
const int chipSelectPin = 53;//el pin 53 es el pin utilizado
para enviar la senal de inicio del SPI

264

static unsigned int data_high;

/*** Declaracion y asignacion de pines para los sensores ***/


const int pingyro=0;//gyro 14
const int pin_pot=2;

/*** Declaracion y asignacion de pines para el manejo del puente


H ***/
const int pin4=4;
const int pin5=5;
const int pin6=6;
const int pin7=7;

//*** Declaracion
indicacion ***/

asignacion

de

pines

para

los

LEDS

de

const int LED_verde=10;


const int LED_ama=11;

/************************
*******************/

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);

//registro del timer count 2, para setear el preescaler este


para el 1280 se setea en el TCCR2B en los tres primeros bits
menos signifitivos en 1-0-0 para 64.
TCCR2B=0x04;
// Use normal mode el registro se encuentra en el TCCRB para el
1280 en los bits del wave gemeration mode(WGM), para modo normal
los bits son 0-0-0
//este registro se encuentra en la pagina 186 data.
//TCCR2 |=(0<<WGM21) | (0<<WGM20);
TCCR2A=0x00;
// TCCR2B |=(0<<WGM22);
//usar el reloj interno no el del arduino.
// Use internal clock external clock not used in Arduino
ASSR=0x00;

//registro de mascara de timers para interrupcion me activa la


interrupcion por desbordamiento poniendo en 1 el bit del
//interrupcion por desbordamiento del timer 2 activado(TOIE2) y
colocando en 0 el bit de salida comparada de la interrupcion
activada del timer 2 (0CIE2A)
TIMSK2=0x01;

//Timer2 Overflow Interrupt Enable

TCNT1=0x00;// la esta haciendo 125 veces por segundo


sei();

266

/*** Inicilalizar el vector a ceros para el filtro digital ***/


float numa[k];
for (int n = 0 ; n<=k-1; n++ ){
numa[n] = 0;}

float numg[u];
for (int n = 0 ; n<=u-1; n++ ){
numg[n] = 0;}

//Inicilaizamos la libreria SPI


Spi.mode((2<<SPR0));
clock / 16

// set SPI clock to system

/*** Definimos el modo de los pines-entradas o salidas ***/

//modo del pin CS como salida inicia la comunicacion


pinMode(chipSelectPin, OUTPUT);

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;}

/*** funcion de usuario para obtener el angulo ***/


float Incli(){

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

float P_Vg(int pingyro){


numg[u-1]=analogRead(pingyro);
for(int i=0;i<=u-2;i++){
numg[i]=numg[i+1];}
int s=0;
int n=0;
while(n<=u-1){
s=s+numg[n];
n++;}
int pro=s/u;
int g=pro-G_OFFSET;
float gyro=g*p/scale_GX ;//velocidad angular
return pro;}

/********** Funcion de calculo de balance ********/

269

vel

angular

void Cal_angle(float pva,float pvg){


int lbyas=0;
int rbyas=0;
angle = a * (angle + pvg*dt); //integracion, filtro pasa altas
angle += (1-a)*(pva);

//filtro pasa bajas

motor += (Kp * angle) + (Kd *pvg);


if(motor>=0){
lbyas=lbyas;
rbyas=rbyas;}
else{
lbyas=-lbyas;
rbyas=-rbyas;}

lmotor=lbyas+motor;
rmotor=rbyas+motor;

/* saturacion! */
if (lmotor >=pwmmax) { lmotor = pwmmax; }
else if (lmotor < -pwmmax) { lmotor =-pwmmax; }

if (rmotor >= pwmmax) { rmotor = pwmmax; }


else if (rmotor < -pwmmax) { rmotor = -pwmmax; }

/*** PWM de control para los motores ***/


/*********************
DIRECCION
**************************/

DE

/*** transistores de motor izquierdo T6 y T7 ***/


/*** transistores de motor izquierdo T4 y T5 ***/

270

LOS

MOTORES

// saturacion motor izquierdo //


if (lmotor >= 0){
digitalWrite(pin4,LOW);
analogWrite(pin5,lmotor);}

else if(lmotor<0){
digitalWrite(pin5,LOW);
analogWrite(pin4,-lmotor);}
// saturacion motor derecho //
if(rmotor >=0) {
digitalWrite(pin6,LOW);
analogWrite(pin7,rmotor);}

else if (rmotor <0){


digitalWrite(pin7,LOW);
analogWrite(pin6,-rmotor);}
}

/***************************************
************************************/

SPI

/*** funciones para comunciacion SPI ***/


//funcion readRegister(registro, cuantos bytes), esta funcion
me permite leer el registro del inclinometro.

unsigned int readRegister(byte thisRegister) {


byte inByte = 0;
leido por SPI

// inicializar byte

unsigned int result = 0;


variable

// retornamos esta

271

// combinamos la direccion y el comando en un solo byte para


enviar por el serial.
byte dataToSend = thisRegister & READ;
// chip select debe estar abajo para iniciar la comunicacion.
digitalWrite(chipSelectPin, LOW);
//enviamos la direccion de registro y a la vez recibimos los
bits menos significativos LSB del inclinometro.
result=Spi.transfer(dataToSend);
//enviamos un byte de ceros para poder desplazar los bits MSB
que aun quedan por enviar.

inByte=Spi.transfer(0x00);

//despazamos el result 8 unidades a la izq para combinarlos con


los MSB
result = result << 8;
// combinamos los dos BYTES que se obtuvieron.
result = result | inByte;

digitalWrite(chipSelectPin, HIGH);
digitalWrite(chipSelectPin, LOW);
Spi.transfer(0x00);
Spi.transfer(0x00);
digitalWrite(chipSelectPin, HIGH);
return(result);}

//enviamos los comandos al ADIS16203

void writeRegister(byte thisRegister, byte thisValue) {


byte dataToSend = thisRegister & READ;
//combinamos los bits para enviar el byte.
dataToSend = dataToSend | WRITE;

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

ANEXO D. COMUNICACIN SPI CON INCLINOMETRO ADIS16203.


La comunicacin SPI es un protocolo de comunicacin serial estndar, utilizado
entre dispositivos electrnicos para su utilizacin conjunta, pero debe tenerse
un respectivo cuidado cuando se comunican estos dispositivos ya que existen
breves variaciones en el protocolo

para algunos dispositivos, por tanto la

lectura y el conocimiento del datasheet del sensor ADIS16203 es primordial.


En la comunicacin SPI se tiene un mster y un Slave, cada uno cumple una
funcin de emisor y receptor, el master sincroniza la comunicacin por medio el
serial clock (SCLK), en nuestro caso el mster es el microcontrolador y el Slave
es el sensor de inclinacin, la figura 146 ilustra cmo es la comunicacin SPI
entre estos dos dispositivos.

Figura 149. Configuracin maestro esclavo en la comunicacin SPI.

Debido a que utilizaremos la librera para SPI de Arduino, Primero se debe


conocer la librera de la que disponemos y analizar que realiza la funcin
miembro de la librera Spi.h.
Spi.transfer (0x2A)
Esta funcin miembro permite enviar y recibir un byte del bus SPI, es decir
permite enviar un byte desde el mster, con la direccin del registro que desea

274

leer del dispositivo, y a su vez recibe un byte con la informacin que le entrega
el dispositivo Slave.

La figura 147, muestra el modo de comunicacin SPI, para el envi de datos


hacia el ADIS16203.

Figura 150. Secuencia de bits para el envi de datos para obtener la inclinacin.

Como se observa en la figura 147, antes de iniciar cualquier envi de datos, el


chip select (CS), debe estar en bajo, aqu el serial clock SCLK coordina el
envo de datos en el flanco de bajada del pulso; para el envi de datos se
tienen:
2 bits, el primero con la informacin de si es escritura o lectura (Read
(0) o Write(1)), como estamos escribiendo o enviando el valor de este
primer bit es 1, el siguiente bit es siempre 0.

Los otros 6 bits del byte (A5-A0), contienen la direccin de registro,


segn lo que se desea leer (inclinacin entre 180 y -180, inclinacin 0
a 360, temperatura C, etc.), las direcciones de registro de salida del
inclinmetro ADIS16203, se muestran en la tabla 34. Debido a que solo
requerimos leer inclinacin entre 0 y 360 solo necesitamos la direccin
de registro con nombre INCL_OUT registro 0x0D o 0x0C.

275

Tabla 37. Direcciones de registros de datos de salida del inclinmetro.

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.

Figura 151. Secuencia de datos para la lectura.

El contenido de la informacin desde el sensor es entregada luego de recibir la


direccin del registro, se debe notar que ocurre,con el chip Select (CS) cuando
enviamos el byte del registro, y quedan un byte que dice dont care luego el
chip select pasa a alto y luego a bajo para recibir la informacin desde el
sensor, esta informacin son 16 bits de los cuales 14 son de la informacin real
de inclinacin.
Por tanto se debe enviar la direccin de registro utilizando la funcin:

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.

Figura 151. Secuencia de lectura SPI del inclinmetro.

277

ANEXO E. RESUMEN DEL DATASHEET GIROSCOPIO IDG 500.

278

279

280

281

282

ANEXO F. RESUMEN DATASHEET GIROSCOPIO LISY300AL.

283

284

285

También podría gustarte