81
DISEÑO Y CONTROL DE UN DRON CON EVASIÓN DE OBSTACULOS TÍTULO: Diseño y control de un dron con evasión de obstáculos AUTOR: Lago Canadas, Julio FECHA DE PRESENTACIÓN: Octubre, 2017

Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

  • Upload
    others

  • View
    4

  • Download
    0

Embed Size (px)

Citation preview

Page 1: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

DISEÑO Y CONTROL DE UN DRON CON EVASIÓN DE

OBSTACULOS

TÍTULO: Diseño y control de un dron con evasión de obstáculos

AUTOR: Lago Canadas, Julio

FECHA DE PRESENTACIÓN: Octubre, 2017

Page 2: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

RESUMEN

Este proyecto tiene como objetivo construir un dron con capacidad de navegar en interiores esquivando los obstáculos, tales como paredes, muebles, personas, etc. En la memoria que viene a continuación se describen los elementos de hardware y de software que se han empleado, los resultados obtenidos así como las alternativas que se han considerado durante el estudio. Los elementos principales utilizados han sido: - Dron adquirido por piezas de 250x250mm entre ejes de rotor - Emisora TGY 9x - Placa Arduino Mega - Sensores de ultrasonidos HC-SR04 (4 unidades) Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios. Por ejemplo en tareas de inspección, vigilancia, rescate, etc. Lo que se persigue es que el operador del dron pueda liberar su atención de la evitación de obstáculos cuando vuela en espacios estrechos. Las maniobres de evitación deben ser realizada automáticamente por el dron, de forma que el operador pueda concentrarse en su tarea principal.

Palabras clave (máximo 10):

Dron Arduino IDE Arduino Mega Sensores ultrasonidos

Bluetooth Multiwii

Page 3: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

ABSTRACT

This project aims to build a drone with ability to navigate indoors dodging obstacles such as walls, furniture, people, etc. In the following memory we describe the hardware and software elements that have been employed, The main elements used have been: - Drone acquired by parts of 250x250mm between rotor axes - Transmitter TGY 9x - Arduino Mega Board - Ultrasonic Sensors HC-SR04 (4 units) Drones have many applications and some of them require navigation in small spaces or interiors of buildings. For example in tasks of inspection, surveillance, rescue, etc. What is pursued is that the drone operator can release the required attention to avoid obstacles when flying in tight spaces. The avoidance maneuvers must be performed automatically by the drone, so that the operator can concentrate on its main task.

Keywords (10 maximum):

Drone Arduino IDE Arduino Mega Ultrasonic sensors

Bluetooth Multiwii

Page 4: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Sumario

Contenido

1. OBJETIVO DEL PROYECTO ........................................................................................... 8

2. QUE ES UN DRON ............................................................................................................. 9

3.1 Tipos de drones ....................................................................................................................... 14

4. COMPONENTES DE UN QUADCOPTER .................................................................. 17

4.1 Chasis ...................................................................................................................................... 18

4.2 Motores .................................................................................................................................. 19 4.2.1 Tamaño ..................................................................................................................................... 20 4.2.2 Vueltas por cada voltio de alimentación................................................................................... 20 4.2.3 Empuje ...................................................................................................................................... 21 4.2.4 Corriente máxima absorbida .................................................................................................... 22 4.2.5 Sentido de giro .......................................................................................................................... 22

4.3 Control electrónico de la velocidad de los motores ................................................................. 23

4.4 Batería .................................................................................................................................... 25

4.6 Controladora de vuelo ............................................................................................................. 28 4.6.1 Controladora de vuelo seleccionada ......................................................................................... 29 4.6.1.1 Componentes para control de vuelo .................................................................................... 29 4.6.2 Alternativas de controladoras ................................................................................................... 34

5. INSTALACIÓN SOFTWARE DE VUELO ................................................................... 35

5.1 Características de Multiwii ...................................................................................................... 35

5.2 Emisora y receptor de 8 canales .............................................................................................. 37

6. ESCANEANDO EL ENTORNO ..................................................................................... 38

6.1 Sensor ultrasónico HC-SR04..................................................................................................... 39 6.1.1 Estudio del sensor de ultrasonidos HC-SR04 ............................................................................ 40

6.2 Sensor de distancia óptico Sharp GP2Y0A02YK0F .................................................................... 42

6.3 Sensor de distancia Garmin LIDAR-Lite v3 ............................................................................... 43

7. ESQUEMA DE CONEXIÓN ........................................................................................... 44

8. COMUNICACIÓN MEDIANTE BLUETOOTH ........................................................... 46

9. CAPTURA DE DATOS ................................................................................................... 48

Page 5: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

9.1 Lectura de los sensores de ultrasonidos .................................................................................. 48 9.1.1 Medición mediante la función PULSEIN() ................................................................................. 48 9.1.2 Medición mediante interrupciones de hardware ..................................................................... 50 9.1.2.1 Interrupción por pin ............................................................................................................. 52 9.1.2.2 Interrupción por cambio de estado en un conjunto de pines .............................................. 53

9.2 Lectura de la emisora .............................................................................................................. 54

10. ANÁLISIS DE DATOS ................................................................................................ 58

10.1 Filtros de distancia .................................................................................................................. 58 10.1.1 Filtro de máximos y mínimos ................................................................................................ 58

10.2 Suavizado de las lecturas ......................................................................................................... 59

10.3 Reacción en función de la velocidad ........................................................................................ 59

10.4 Reacción en función de la distancia ......................................................................................... 60

11. PRUEBAS DE VUELO ................................................................................................ 63

12. DISEÑO E IMPRESIÓN DE PIEZAS ....................................................................... 65

13. PRESUPUESTO .......................................................................................................... 68

13.1 Coste personal ........................................................................................................................ 68

13.2 Coste material ......................................................................................................................... 69

13.3 Coste impresión ...................................................................................................................... 70

13.4 Coste final prototipo ............................................................................................................... 70

14. CONCLUSIONES ......................................................................................................... 71

15. FUTURAS LÍNEAS DE TRABAJO ........................................................................... 73

BIBLIOGRAFÍA ...................................................................................................................... 74

Page 6: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

SUMARIO DE FIGURAS

FIGURA 1 MISIL DE CRUCERO TOMAHAWK 9 FIGURA 2 DRON PREDATOR 9 FIGURA 3 OCTOCOPTER CON SISTEMA DE ESTABILIZACIÓN GIMBALL Y CÁMARA DE VIDEO [6] 10 FIGURA 4 DRON TINY WHOOP 11 FIGURA 5 DJI PHANTOM 4 11 FIGURA 6 DJI MAVIC PRO 11 FIGURA 7 VUELO AUTÓMATA CON DETECCIÓN DE OBSTÁCULOS POR VISIÓN ARTIFICIAL [12] 12 FIGURA 8 TÉCNICAS DE VISIÓN ARTIFICIAL PARA POSICIONAMIENTO DEL DRON HOVER CAMERA [13] 13 FIGURA 9 DRON HOVER CAMERA CON VISIÓN ARTIFICIAL [14] 13 FIGURA 10 HELICÓPTERO CONVERTIBLE V-22 OSPREY 14 FIGURA 11 DRON TR-60 CON ROTORES BASCULANTES EN POSICIÓN VERTICAL 14 FIGURA 12 DRON DE DOS ROTORES EN LÍNEA [17] 14 FIGURA 13 DRON TR-60 CON ROTORES BASCULANTES EN POSICIÓN HORIZONTAL 14 FIGURA 14 DRON DE 3 ROTORES [18] 15 FIGURA 15 DRON DE CUATRO ROTORES DJI (CHINA) [19] 15 FIGURA 16 MEGA DRONE DE EHANG (CHINA) [21] 15 FIGURA 17 DRON TINYWHOOP (USA) [20] 15 FIGURA 18 DRON DE 6 ROTORES [22] 16 FIGURA 19 CARGO DRONE (CHINA) [23] 16 FIGURA 20 CONFIGURACIÓN EN X. PARTE DE POTENCIA, INSTRUMENTOS Y PLACA CONTROL VUELO 17 FIGURA 21 DRON DE PROYECTO CON PROTOBOARD EN FASE DE ENSAYOS 17 FIGURA 22 CHASIS DARDO 250 18 FIGURA 23 COMPOSICIÓN KIT CHASIS DARDO 250 18 FIGURA 24 MOTOR KINGKONG 2204 2300KV 19 FIGURA 25 CONFIGURACIÓN INTERNA MOTOR BRUSHLESS [28] 19 FIGURA 26 FLUJO MAGNÉTICO EN UN MOTOR PASO A PASO OUTRUNNER DE 12 POLOS [29] 19 FIGURA 27 PESO DEL CONJUNTO EN BASCULA 21 FIGURA 28 ESPECIFICACIONES MOTOR KING KONG 2204 2300KV 21 FIGURA 29 SENTIDO DE GIRO DE LOS MOTORES 22 FIGURA 30 CIRCUITOS MAGNÉTICOS DE UN MOTOR PASO A PASO DE 12 POLOS Y 16 IMANES

PERMANENTES [29] 23 FIGURA 31 ELEMENTOS DE UN MOTOR PASO A PASO OUTRUNNER [28] 23 FIGURA 32 CHASIS CON LOS ESC SOLDADOS A LA PLACA PCB 24 FIGURA 33 CARACTERÍSTICAS DE LOS ESC CON FIRMWARE 13.2 24 FIGURA 34 CARACTERÍSTICAS DE LOS ESC CON FIRMWARE 14.9 25 FIGURA 35 BATERÍA TURNIGY 2200 MAH 26 FIGURA 36 BATERÍA TURNIGY 2600 MAH 26 FIGURA 37 AVISADOR DE TENSIÓN PARA BATERÍAS DE 2 A 8 CELDAS [34] 27 FIGURA 38 ESQUEMA CONEXIONES ARDUINO NANO Y SENSORES 29 FIGURA 39 PLACA ARDUINO NANO 30 FIGURA 40 TABLA DE CARACTERISTICAS ARDUINO NANO ATMEGA328 30 FIGURA 41 PLACA GY-521 CON ACELERÓMETRO Y GIROSCOPIO MPU-6050 30 FIGURA 42 FRAGMENTO DEL PROGRAMA DE ADQUISICIÓN DE DATOS DE LA TRAMA 31 FIGURA 43 ECUACIÓN CÁLCULO ÁNGULO EJE X 31 FIGURA 44 ECUACIÓN CÁLCULO ÁNGULO EJE Y 31 FIGURA 45 INTERPRETACIÓN GY-521 31 FIGURA 46 INTERPRETACIÓN GY-521 31 FIGURA 47 SENSOR HMC-5883L [38] 32 FIGURA 48 SENSOR BMP-180 [39] 32 FIGURA 49 ESQUEMA ARDUINO Y SENSORES (DIBUJADO CON FRITZING) [40] 33 FIGURA 50 PCB PARA ARDUINO DE VUELO Y SENSORES 33 FIGURA 51 PCB DE ARDUINO DE VUELO CON SENSORES 33 FIGURA 52 CONTROLADORA MICRO CC3D [41] 34 FIGURA 53 PANEL DE CONTROL EN PC DE MULTIWII [42] 35 FIGURA 54 MUESTRA DE ARCHIVOS GESTIONADOS POR MULTIWII 36

Page 7: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

FIGURA 55 EMISORA TGY 9X 37 FIGURA 56 LCD CON RETROILUMINACIÓN 37 FIGURA 57 RECEPTOR TGY DE 8 CANALES 37 FIGURA 58 LECTURA, ANÁLISIS Y ENVÍO. 38 FIGURA 59 SENSOR DE ULTRASONIDOS HCSR04 39 FIGURA 60 CHASIS DE SENSORES DE ULTRASONIDOS 40 FIGURA 61 LECTURA SENSOR HCSR04 41 FIGURA 62 MEDICIÓN DE 107 CM 41 FIGURA 63 SENSOR IR SHARP GP2Y0A02YK0F 42 FIGURA 64 SENSOR GARMIN LIDAR LITE-V3 43 FIGURA 65 INTERCONEXIÓN ENTRE PLACAS RECEPTORA, DE ANÁLISIS Y DE VUELO. 44 FIGURA 66 ESQUEMA CONEXIONES SENSORES A PLACA DE ANÁLISIS ARDUINO MEGA 45 FIGURA 67 ESQUEMA CONEXIONADO BLUETOOTH - ARDUINO DE VUELO 46 FIGURA 68 MÓDULO BLUETOOTH MODIFICADO 47 FIGURA 69 CONEXIÓN MODULO BLUETOOTH ARDUINO MEGA 47 FIGURA 70 ESQUEMA DE CONEXIÓN DE UN SENSOR A LA PLACA ARDUINO MEGA 48 FIGURA 71 CAPTURA DE PULSEIN() DE LA PÁGINA WEB ARDUINO [49] 49 FIGURA 72 LECTURA US MEDIANTE PULSEIN() 49 FIGURA 73 CAPTURA DE LA SEÑAL ECHO Y TRIGGER 49 FIGURA 74 CAPTURA PARCIAL DE LA FUNCIÓN ATTACHINTERRUPT() DE LA PÁGINA [50] 51 FIGURA 75 ACTIVAR INTERRUPCIÓN PIN 3 ARDUINO MEGA 52 FIGURA 76 CAPTURA DE LA FUNCIÓN (ECHO_1) DEL SENSOR DE ULTRASONIDOS FRONTAL 52 FIGURA 77 EJEMPLO DE TRAMA EN MODO PPM DE UNA EMISORA DE 7 CANALES [51] 54 FIGURA 78 TABLA DE PINES DEL CONTROLADOR MEGA2560 [36] 55 FIGURA 79 POTENCIÓMETRO VARIABLE KP 56 FIGURA 80 MOVIMIENTOS DE UNA AERONAVE [52] 56 FIGURA 81 CAPTURA DE CÓDIGO LECTURA RECEPTOR RX 57 FIGURA 82 FILTRO DE MÁXIMOS Y MÍNIMOS EN EL SENSOR DELANTERO 59 FIGURA 83 SUAVIZADO CON MEDIA MÓVIL DE LAS ÚLTIMAS 5 LECTURAS 59 FIGURA 84 FRAGMENTO DE PROGRAMA POR TIEMPO ESTIMADO DE COLISIÓN 60 FIGURA 85 CAPTURA DE LA CORRECCIÓN ESCALÓN EN FUNCIÓN DE “D_COLISION” 60 FIGURA 86 OBJETO FUERA DE ZONA DE REACCIÓN 63 FIGURA 87 OBJETO APROXIMÁNDOSE A ZONA DE REACCIÓN 63 FIGURA 88 OBJETO EN ZONA DE REACCIÓN 63 FIGURA 89 REACCIÓN DE EVASIÓN PARA ALEJARSE DEL OBJETO 64 FIGURA 90 DRON ALEJÁNDOSE DEL OBJETO 64 FIGURA 91 PROTOTIPO DE DRON CON LOS SENSORES DE ULTRASONIDOS 64 FIGURA 92 DISEÑO DEL CHASIS DE SENSORES DE ULTRASONIDOS 65 FIGURA 93 DISEÑO DE LA TAPA INFERIOR PARA ALOJAR UN QUINTO SENSOR 65 FIGURA 94 VISTAS DEL CHASIS DE SENSORES DE ULTRASONIDOS IMPRESO CON PLA 66 FIGURA 95 CHASIS DE LOS SENSORES MONTADO EN EL DRON 66 FIGURA 96 DISEÑO DE LA PATA IMPRESA EN PLA 67 FIGURA 97 IMPRESIÓN 3D DE UNA DE LAS PATAS 67

Page 8: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

8

1. OBJETIVO DEL PROYECTO

Los drones se están expandiendo rápidamente por la cantidad de aplicaciones que tienen. En el vuelo en exteriores los drones gozan de una doble ventaja: mucho espacio para maniobrar y posicionamiento mediante GPS, lo que les permite una estabilidad y control de vuelo notables. En la navegación en interiores, en cambio, los drones encuentran problemas debido a la estrechez de los volúmenes de vuelo y la no disponibilidad de GPS, el cual no funciona correctamente dentro de los edificios. A la vista de esta carencia nos planteamos como objetivo construir un dron con capacidad para navegar en el interior de los edificios evitando los obstáculos de modo autónomo y liberando al operador para concentrarse en su tarea. Se procesan los datos de la siguiente manera.

a) Lectura de órdenes de vuelo procedentes de la emisora. b) Lectura de distancias y mapeado del entorno por medio de los sensores de

ultrasonidos. c) Cálculo de las correcciones de las órdenes de vuelo para evitar las colisiones. d) Envío de órdenes de vuelo corregidas a la placa de control de vuelo. e) Corrección del vuelo y nuevo ciclo de lectura.

El dron debe medir las distancias al entorno en 2 ejes perpendiculares, delante, detrás, izquierda y derecha. Con una disposición en cruz.

Page 9: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

9

2. QUE ES UN DRON

Un dron, del inglés drone [1]: zángano o abeja macho, es un vehículo en general dotado de varias hélices y sin planos de vuelo que basa su estabilidad en un control de alta frecuencia y sensores electrónicos dirigidos por un microprocesador. Los drones normalmente son vehículos no tripulados, aunque hay en desarrollo algunos modelos enfocados al transporte de personas, aún sin comercializar. El uso de vehículos no tripulados UAV [2] Unmanned Aerial Vehicle se desarrolló originalmente para la industria militar. Hace ya más de 30 años que los misiles Tomahawk eran capaces de volar autónomamente reconociendo el terreno y guiándose solos hasta su objetivo. Técnicamente hablando los Tomahawk [3] eran drones salvo la ausencia de hélices y presencia de planos de vuelo.

Los UCAV [4] Unmanned Combat Aerial Vehicle, son vehículos capaces de portar armamento para atacar objetivos como el conocido Predator [5].

Figura 2 Dron Predator

Figura 1 Misil de crucero Tomahawk

Page 10: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

10

En la última década se han abaratado mucho y se ha generalizado su uso, gracias al descenso de los precios de material electrónico. Aunque su uso inicial era el militar, actualmente está aumentando mucho su uso civil. En la actualidad podemos ver drones dedicados a labores de inteligencia y seguimiento, inspección de líneas de alta tensión, levantamientos topográficos, exploración de espacios peligrosos, etc. En el mundo del cine los drones han sustituido a los helicópteros en muchas tomas, con la consiguiente reducción de coste.

Figura 3 Octocopter con sistema de estabilización gimball y cámara de video [6]

Page 11: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

11

3. ESTADO DEL ARTE Actualmente tenemos una oferta muy amplia de drones en el mercado. Desde los diminutos tiny whoop [7] hasta drones capaces de levantar decenas que Kg. Los drones Tiny Whoop, están pensados principalmente para su uso en interiores, disponen de cámara, con la cual podremos ver mediante FPV (First Person View) [8], como si el piloto que maneja la emisora estuviese dentro del dron. De todos los drones disponibles en el mercado, mencionaremos algunos de los más equipados, que disponen de cámaras y sensores de distancias. El fabricante chino DJI [9], ha sido pionero en muchas novedades tales como, seguimiento de personas u objetos (follow me), vuelta al punto de despegue automatizada (return home), enviar el dron a un destino marcado en un mapa, y ahora nos sorprenden con sistemas de detección de obstáculos. La incorporación de sensores de entorno ha sido un paso más en el camino de estas máquinas hacia el vuelo autónomo. Podemos enviarlos de un punto a otro, sin riesgo de dañarlos por los obstáculos que se encuentren en el camino.

Figura 4 Dron Tiny Whoop

Figura 6 DJI Mavic Pro Figura 5 DJI Phantom 4

Page 12: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

12

Tanto el Mavic Pro como el Phantom 4 ambos del fabricante DJI nos ofrecen un sistema de detección de obstáculos en los cuatro costados. Cuadro comparativo de cuatro quadcopter equipados con sensores de distancia:

Dji Mavic pro

Dji phantom

Gopro Karma [10]

Yuneec Typhoon

4 H Pro [11] Precio 1499,00€ 1699,00€ 1199,00€ 1199,00€ Peso (g) 725 1388 1000 2060

Distancia entre rotores (mm) 335 350 365,2 520

Protectores de hélice No No No No Duración batería (minutos) 27 30 20 25 Alcance emisora (km) 7 7 3 1,6 Velocidad máxima (km/h) 65 72 56 70 Vuelta a casa Si Si No Si Resolución (MP) 12 MP 20 MP 12 MP 12 MP Campo de visión (º) 360 120 90 94 Modo seguimiento Si Si No Si Espacio aéreo limitado Si Si Si Si Sistema de

detección de 15 metros 30 metros No Si obstáculos

Además de los modelos comerciales referidos, existen desarrollos que en cualquier momento puede salir en el mercado.

Figura 7 Vuelo autómata con detección de obstáculos por visión artificial [12]

Page 13: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

13

La visión artificial puede proporcionar un método de posicionamiento en interiores de alta precisión sin necesidad de otras referencias externas. Es la técnica más cercana a un vuelo completamente autónomo.

Figura 8 Técnicas de visión artificial para posicionamiento del dron Hover Camera [13]

Figura 9 Dron Hover Camera con visión artificial [14]

Page 14: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

14

3.1 TIPOS DE DRONES

Dentro de los drones encontramos diferentes tipos de combinaciones según la cantidad de hélices que tengan. A continuación se describen algunos de ellos.

• Dron de 2 rotores. Este tipo de drones no son los más usuales debido a su mala maniobrabilidad en vuelo. Actualmente Corea está desarrollando un modelo (probablemente con fines militares) basado en rotores basculantes y planos de vuelo denominado TR-60 [15]. Según pruebas declaradas, es capaz de transportar una carga de hasta 50 kg, alcanzar una velocidad máxima de 500 km/h y mantenerse en vuelo hasta un máximo de 6 horas. LA configuración recuerda al V-22 “Osprey” [16] que el ejército de USA estuvo desarrollando durante años y que acabo por ser un desarrollo muy caro. La diferencia es que el V-22 es una aeronave tripulada.

Figura 12 Dron de dos rotores en línea [17]

Figura 11 Dron TR-60 con rotores basculantes en posición vertical

Figura 13 Dron TR-60 con rotores basculantes en posición horizontal

Figura 10 Helicóptero convertible V-22 Osprey

Page 15: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

15

• Dron de 3 rotores. Este tipo de drones son poco habituales al igual que los drones de 2 rotores por su difícil maniobrabilidad. Es fácil conseguir horizontalidad y el desplazamiento lateral, pero es difícil el control de yaw (giro o estabilidad respecto al eje z). Normalmente se requiere que uno o más rotores sean parcialmente basculantes.

• Los drones de 4 rotores son los más extendidos debido a su simplicidad y maniobrabilidad. Para conseguir todos los movimientos no es necesario que los rotores sean basculantes, lo que simplifica su construcción. Estos drones son usados en todo tipo de tareas, bien profesionales o lúdicas. Su escala va desde los diminutos poco mayores que un insecto hasta prototipos en desarrollo de dimensiones métricas destinados al transporte de personas.

Figura 14 Dron de 3 rotores [18]

Figura 15 Dron de cuatro rotores DJI (China) [19]

Figura 17 Dron Tinywhoop (USA) [20] Figura 16 Mega drone de Ehang (China) [21]

Page 16: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

16

• Los drones de 6 u 8 rotores son aeronaves, en general de mayores dimensiones, muy estables y útiles para trabajar en zonas con mucho viento. Son menos populares debido a su tamaño. Los drones con 6 o más hélices también son usados para transporte de cargas.

Figura 18 Dron de 6 rotores [22]

Figura 19 Cargo drone (China) [23]

Page 17: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

17

4. COMPONENTES DE UN QUADCOPTER

Los elementos básicos de un quadcopter son, el chasis, los motores, los ESC (Electronic Speed Controller) [24], la unidad de control de vuelo y la emisora de control. El dron utilizado para este proyecto está compuesto por 4 motores orientados en forma de X.

Figura 20 Configuración en X. Parte de potencia, instrumentos y placa control vuelo

Figura 21 Dron de proyecto con protoboard en fase de ensayos

Page 18: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

18

A continuación se describen con más detalle los componentes elegidos para este proyecto. 4.1 CHASIS

Armazón donde se fijan las partes electrónica y mecánica del dron. Podemos encontrar un amplio surtido de chasis en el mercado, dentro de estos podemos encontrar dos tipos, únicamente chasis o, chasis con PCB (Printed Circuit Board) integrado. Estos últimos facilitan la instalación eléctrica reduciendo la cantidad de cables ya que la misma placa tiene un circuito impreso, quedando con un aspecto mucho más limpio y compacto. El modelo que se ha escogido es de la tienda online Hobbyking: el Dardo 250 de FUN-RC [25]. Éste modelo tiene placa PCB integrada para la alimentación de los motores y tiene una parrilla con 4 leds en la parte delantera. En la parte superior de la figura 14 podemos apreciar la PCB del chasis Dardo 250. La razón por la que se ha escogido la medida de 250mm es porque es un compromiso adecuado entre la necesidad de volar en interiores y la capacidad de elevar las cargas adicionales que le vamos a instalar.

Figura 22 Chasis Dardo 250 Figura 23 Composición kit chasis Dardo 250

PCB

Page 19: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

19

4.2 MOTORES

Cada dron necesita el número de motores marcado por su configuración. En nuestro caso cuatro motores del tipo outrunner (con el rotor exterior, cuando el rotor es interior se denomina inrunner). Los motores más utilizados en drones son trifásicos sin escobillas (brushless) [26], ya que estos motores no tienen apenas desgaste ni mantenimiento por la ausencia de elementos de fricción. El único elemento sometido a desgaste por rozamiento son los cojinetes. La vida de los motores depende en alto grado de la calidad de sus rodamientos. Los motores elegidos son de la marca King Kong, modelo 2204 2300Kv [27]. A continuación se explica el porqué de esta elección.

Figura 24 Motor Kingkong 2204 2300Kv Figura 25 Configuración interna motor brushless [28]

Figura 26 Flujo magnético en un motor paso a paso outrunner de 12 polos [29]

Page 20: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

20

4.2.1 TAMAÑO

El tamaño de los motores está escalonado según una nomenclatura de amplio uso. Podemos determinar las características a partir de su referencia:

2204 2300Kv Lo primero que encontramos es un número de cuatro cifras, en este caso 2204. Las dos primeras cifras (22) determinan el diámetro en mm del núcleo del motor donde van los bobinados y que es el estator. La parte externa es el rotor del motor, es la que da vueltas y en ella se alojan los imanes permanentes. El segundo valor (04) nos indica la altura de los polos electromagnéticos en milímetros1. 4.2.2 VUELTAS POR CADA VOLTIO DE ALIMENTACIÓN

La velocidad de estos motores en vacío es sensiblemente proporcional a la tensión de alimentación. El parámetro KV hace referencia a esta proporcionalidad, e indica cuantas revoluciones adquiere el motor en vacío por cada voltio de alimentación. Por ejemplo un motor de 2300Kv con una batería del tipo LIPO de 3 celdas con 3.7 V por celda hará que el motor gire en vacío a 25.530min-1.

ω = 2300 ���

∗ 3.7

�����∗ 3 ����� = 25.530 ���

El empuje de una hélice es proporcional a su velocidad, al ángulo de ataque y al cuadrado de su diámetro. Si tenemos un motor con menos revoluciones podemos conseguir el mismo empuje con hélices de mayor diámetro o mayor ángulo de ataque.

1 Se ha consultado en varias fuentes el significado del primer grupo de cuatro cifras en la designación de un motor brushless para dron. Hay bastante consenso en que las primeras dos cifras expresan el diámetro del estator en mm, aunque en algún caso parecen designar el diámetro de todo el motor. El segundo par de cifras, en cambio, no está claro. Por ejemplo, en http://www.dronetrest.com/t/brushless-motors-how-they-work-and-what-the-numbers-mean/564 indica que corresponden a la longitud del estator.

Page 21: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

21

4.2.3 EMPUJE

El empuje es la característica clave a la hora de elegir un motor para un dron. Este dato nos lo facilita el fabricante y viene en la hoja de características del motor. Se da en gramos de fuerza y depende del diámetro de la hélice. La determinación de la medida de las hélices viene dado por el parámetro de velocidad máxima del motor. El fabricante recomienda que el diámetro de las hélices se encuentre entre las cinco y las seis pulgadas. Para este dron se han escogido hélices 5040, las dos primeras cifras indican el diámetro de la hélice en decimas de pulgada y las dos últimas cifras indican el paso en decimas de pulgada. Una hélice con paso 40 realiza un paso de rosca de 4 pulgadas de longitud. Para una hélice de 5040, de 5 pulgadas de longitud diametral, tendremos:

������ ����� = 4 ∗ 440 � = 1760 ������ La previsión inicial era de 700 gramos de peso teniendo el en cuenta el peso del dron y los componentes a añadir El peso final del conjunto ha resultado ser 785 gramos. Los motores elegidos son los adecuados.

Figura 27 Peso del conjunto en bascula Figura 28 Especificaciones motor King Kong 2204 2300Kv

Page 22: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

22

4.2.4 CORRIENTE MÁXIMA ABSORBIDA

Este dato suele facilitarlo el fabricante en la hoja de características. Es útil para dimensionar los ESC que alimentan los motores. En el caso del motor elegido es de11.5A por unidad. 4.2.5 SENTIDO DE GIRO

El sentido de giro de los motores se suele designar como CW (clockwise) y CCW (counterclockwise). Lo habitual es que los motores de una diagonal giren en un sentido y los de la otra diagonal lo hagan en sentido contrario. De esta forma, si queremos que el dron gire respecto al eje Z, bastará con incrementar la velocidad de una diagonal y reducir la velocidad de la otra para compensar la elevación. La fuerza ascensional será la misma pero habrá una reacción que hará girar el dron alrededor de su eje vertical (yaw).

Figura 29 Sentido de giro de los motores

Page 23: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

23

4.3 CONTROL ELECTRÓNICO DE LA VELOCIDAD DE LOS MOTORES

¿Cómo se controla la velocidad de un motor paso a paso? Al contrario de los motores de continua e incluso los motores asíncronos, los motores paso a paso tienen una velocidad perfectamente definida por el controlador. Un motor paso a paso tiene distinto número de polos en el rotor y en el estator. Uno de ellos esta alimentado por electroimanes y el otro está formado por imanes permanentes. Cuando las bobinas están alimentadas eléctricamente se forman uno o varios circuitos magnéticos desalineados. Los polos de los electroimanes no están exactamente alineados con los polos fijos de los imanes permanentes del rotor. El par del motor procede de la fuerza de atracción entre los polos magnéticos de los imanes fijos y los electroimanes. Es necesario tener número diferente de polos en el rotor y en el estator para poder seleccionar el sentido de giro. Un motor de 12 polos con alimentación trifásica como es nuestro caso forma 4 circuitos magnéticos independientes, tal como se ve en la figura inferior. En cada momento un tercio de las bobinas están sin alimentación eléctrica.

La velocidad de rotación está fijada por la frecuencia de conmutación, la cual se comanda desde la unidad de control. Algunos motores paso a paso están dotados de sensores Hall que sitúan con precisión la posición del rotor. Es esta aplicación, donde la carga es una hélice, la posición del rotor no es un dato necesario y basta con conocer la velocidad de giro, la cual como hemos dicho está fijada por la frecuencia trifásica de mando. Los ESC (Electronic Speed Controller) elegidos son de la marca King Kong. Pueden conmutar hasta 12 Amperios y son compatibles con baterías de 2 a 4 celdas (de 7.4 V a 14.8 V).

Figura 31 Elementos de un motor paso a paso outrunner [28]

Figura 30 Circuitos magnéticos de un motor paso a paso de 12 polos y

16 imanes permanentes [29]

Page 24: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

24

Los ESC vienen de origen con la versión de firmware 13.2 que se ha actualizado a la 14.9. Están dotados con electrónica suficiente para ajustar la velocidad con un PID. La figura inferior muestra los ajustes parametrizables en el PID de control de la velocidad. Para poder actualizarlos es necesario un programa que facilita el fabricante llamado BLHeliSuite [30]. Una vez ejecutado solo será necesario seleccionar el tipo de motor, y el tipo de bootloader de los ESC. El pack de motores y ESC ya incluye un interfaz USB para actualizarlos. No es necesario modificar ningún valor, ya que por defecto vienen calibrados con los valores de fábrica.

Figura 32 Chasis con los ESC soldados a la placa PCB

Figura 33 Características de los ESC con firmware 13.2

Page 25: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

25

4.4 BATERÍA

Las baterías escogidas son de polímero de litio (Li-Po) [31] por sus favorables relaciones potencia/kg, capacidad/kg y tiempo de carga. Las baterías Li-Po vienen agrupadas en paquetes de una o varias celdas por los fabricantes. Pueden estar conectadas en serie o en paralelo. En este caso las baterías que se han usado son de 3 celdas en serie por lo que la tensión nominal es de:

��� =3.7

�����∗ 3 ����� = 11.1

Este tipo de baterías tienen un coeficiente de descarga de corriente máxima. Este coeficiente indica la velocidad de descarga de la batería. Nos indica la cantidad de veces que se puede descargar la batería en una hora. Las características de descarga de la batería Turnigy de 2200 mAh de 25-35C [32] son:

Descarga continua máxima de corriente = 25*C =25*2.2 = 55 A

Descarga máxima de corriente = 35*C = 35*2.2 = 77 A

Figura 34 Características de los ESC con firmware 14.9

Page 26: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

26

Las características de descarga de la batería Turnigy 3S (3 celdas de 3.7 V cada una) de 2600 mAh de 20-30C [33] son:

Descarga continua máxima de corriente = 20*C =20*2.6 = 52 A

Descarga máxima de corriente = 30*C = 30*2.6 = 78 A Durante las pruebas se han usado dos modelos diferentes de baterías debido a un fallo en el avisador de tensión baja. Por esta razón se dañaron las dos primeras baterías de la marca Turnigy de 2200 mAh 25-35C. Las segundas baterías que se han adquirido han sido de la marca Turnigy de 2600 mAh 20-30C. La mayor precaución que hay que tener cuando se usan baterías del tipo Li-Po, es la de no descargar la batería por debajo del 90% de la tensión nominal. Para prevenirlo, es necesario disponer de un avisador de baterías. El síntoma de que una batería Li-Po está en mal estado es su escasa duración y un visible hinchamiento por acumulación de gases en su interior. Ha habido casos de explosión de baterías por mal uso. Se puso un avisador acústico para advertirnos durante el vuelo de baja tensión en la batería. El avisador va embarcado.

Figura 35 Batería Turnigy 2200 mAh

Figura 36 Batería Turnigy 2600 mAh

Page 27: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

27

4.5 RESUMEN DE DIMENSIONAMIENTO DE LOS COMPONENTES DE

POTENCIA

Podemos ver que ningún componente nos crea efecto cuello de botella.

Intensidad maxima motores 4 x 11,5 46 A

Intensidad maxima ESC 4 x 12 48 A

I max bateria 2,2Ah 25 x 2,2 55 A

I max bateria 2,6 Ah 20 x 2,6 52 A

Figura 37 Avisador de tensión para baterías de 2 a 8 celdas [34]

Page 28: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

28

4.6 CONTROLADORA DE VUELO

La controladora de vuelo es una placa que contiene un microprocesador y otros elementos. Va embarcada en el dron y se encarga de traducir las instrucciones de vuelo enviadas desde la emisora en órdenes de velocidad a los distintos rotores del dron para cumplir con la petición. Además del microprocesador la controladora dispone de instrumentación auxiliar, tal como un giroscopio de 3 ejes, un acelerómetro de 3 ejes y un magnetómetro. Eventualmente puede disponer de GPS, barómetro y otros instrumentos de vuelo. La interface entre el usuario y la controladora es el programa de control. En general hay varias posibilidades de elección de la interface. En nuestro caso, habiendo elegido una placa Arduino y sensores por separado, la mejor opción es Multiwii, un programa open source que se describe más adelante. Los modos de vuelo disponibles vienen fijados por la interface entre usuario y controladora.

• Modo acrobático • Modo estable • Modo estático

Aunque suene parecido hay una diferencia entre vuelo estático y vuelo estable. Estático significa que el dron puede permanecer quieto en un punto en el espacio y mantenerlo a pesar de las turbulencias atmosféricas. El vuelo estable mantiene el dron horizontal y con bajas vibraciones, pero puede presentar una deriva en el plano horizontal. Si queremos que un dron este lo más estático posible respecto un punto de referencia es necesario que esté equipado con GPS2. El único problema que tiene este sistema, es la poca precisión en interiores, donde la señal de GPS es muy pobre. En interiores debemos usar sensores laser o ultrasonidos para poder mantener la altitud.

2 La precisión de la señal GPS tal cual (+/- 5 m) no es suficiente como para mantener un dron estático, pero se puede utilizar GPS diferencial el cual requiere dos módulos GPS, uno ubicado en el dron y otro en la emisora.

Page 29: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

29

4.6.1 CONTROLADORA DE VUELO SELECCIONADA

La controladora se ha construido sobre una PCB en la que se inserta un Arduino Nano con chip ATmega328P y el resto de instrumentos de vuelo que se describen más adelante. A partir de la página de Multiwii3 se pueden encontrar instrucciones para la construcción de la controladora. A continuación se muestra el esquema del montaje.

Figura 38 Esquema conexiones Arduino nano y sensores

Se valoró inicialmente la posibilidad de adquirir una controladora en el mercado, pero son sistemas cerrados que no permiten experimentar ni hacer modificaciones. Es por ello que se decidió montarla a partir de componentes sueltos. 4.6.1.1 COMPONENTES PARA CONTROL DE VUELO

• Arduino Nano: Microcontrolador de la familia Arduino con chip ATmega328P [35,

36] que forma el corazón de la controladora. Tiene 22 entradas/salidas, comunicación por puerto serie mini USB, tiene 32 KB de memoria flash y 2 KB de SRAM.

3 http://www.multiwii.com o https://github.com/multiwii, Multiwii, nació como proyecto para poder reciclar los giroscopios incluidos en los mandos de la consola Nintendo Wii y abaratar los costes de fabricación home made de una controladora.

Page 30: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

30

• Placa GY-521: Es una PCB que incorpora el giroscopio y acelerómetro MPU-

6050 y un regulador de voltaje que permite ser alimentado directamente a 5V/3.3V en vez de los 3.3V que únicamente admite el MPU-6050. El circuito integrado MPU-6050 del fabricante InvenSense [37], es un sensor para aplicaciones que requieren control de movimientos. El protocolo de comunicación usado por este sensor es el estándar I2C. Es un giroscopio de 3 ejes con un rango completo de +-250, 500, 1000, 2000 dps (º/s). El acelerómetro de 3 ejes es programable de +-2g hasta +-16g. La resolución es de 16 bits por cada eje.

Figura 41 Placa GY-521 con acelerómetro y giroscopio MPU-6050

Figura 40 Tabla de caracteristicas Arduino nano ATmega328

Figura 39 Placa Arduino nano

Page 31: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

31

Pruebas mediante Matlab del sensor GY-521. Se ha analizado el sensor GY-521 mediante Matlab adaptando un pequeño programa que lee los datos que envía el sensor a través de la tarjeta Arduino al pc. En las figuras se muestra copia de pantalla de la posición de la placa en los ejes X e Y. El Arduino se encarga de leer la trama que envía el sensor GY-521 mediante protocolo I2C y únicamente recogemos los datos de los ángulos del eje X e Y. Gracias a este pequeño programa podemos observar que cualquier movimiento que hagamos con la mano nos lo replicara el cubo visualizado en pantalla.

Figura 45 Interpretación GY-521 Figura 46 Interpretación GY-521

Figura 42 Fragmento del programa de adquisición de datos de la trama

Figura 44 Ecuación cálculo ángulo eje Y Figura 43 Ecuación cálculo ángulo eje X

Page 32: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

32

• Magnetómetro HMC-5883L: El protocolo de comunicación usado por este sensor

es el estándar I2C. Este indica la orientación respecto al campo magnético que lo atraviesa. En otras palabras, es una brújula. Este sensor es muy sensible y puede dar problemas de lecturas distorsionadas cuando está cerca de cables debido a las interferencias electromagnéticas.

• Barómetro BMP-180: El barómetro es un sensor de altura sensible que se puede utilizar para mantener un dron a altura estable en exteriores. Sin embargo su empleo en interiores no da buen resultado debido a que la precisión de la señal es insuficiente y además se producen variaciones provocadas por las turbulencias de las hélices. Por esa razón se ha descartado el uso del mismo en este proyecto.

Figura 47 Sensor HMC-5883L [38]

Figura 48 Sensor BMP-180 [39]

Page 33: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

33

• PCB a medida: Para el proyecto se ha construido una placa a medida para poder

conectar los sensores a la tarjeta Arduino reduciendo así la cantidad de cables y los fallos por malos contactos. Al inicio y para comprobar el funcionamiento del mismo se instaló todo en una protoboard, después de varias pruebas se decidió construir la pcb con zócalos soldados para reducir los fallos producidos por las vibraciones.

Figura 49 Esquema Arduino y sensores (dibujado con Fritzing) [40]

Figura 50 PCB para Arduino de vuelo y sensores

Figura 51 PCB de Arduino de vuelo con sensores

Page 34: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

34

4.6.2 ALTERNATIVAS DE CONTROLADORAS

Actualmente encontramos una gama muy amplia de controladoras de vuelo en el mercado. La que elijamos dependerá del uso que se le vaya a dar al dron, vuelo acrobático, vuelo estable para fotografía y video, barrido de zonas para levantamientos topográficos, etc. Es fácil encontrar en internet videos o blogs que hablan del tema y que pueden constituir una primera guía previa a la elección. Habitualmente los drones se compran como un conjunto completo y cerrado donde todos los componentes y su compatibilidad han sido probados por el fabricante. También existe la posibilidad de adquirir el dron por partes, lo cual proporciona una gran libertad a la hora de escoger los componentes de hardware y software, pero con los riesgos de que el dimensionamiento sea incorrecto o exista incompatibilidad entre componentes. En este proyecto se ha elegido un dron por piezas para tener la máxima libertad a la hora de modificar componentes. Tanto de hardware como de software, y eso incluye la controladora de vuelo.

Figura 52 Controladora Micro CC3D

[41]

Page 35: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

35

5. INSTALACIÓN SOFTWARE DE VUELO

Para este proyecto y dado que había que intervenir en los parámetros, se ha escogido el software open source Multiwii, que permite interactuar con la maquina con más libertad que un software propietario.

5.1 CARACTERÍSTICAS DE MULTIWII

Este software combinado con un módulo bluetooth conectado a la placa Arduino, nos permite cambiar entre los diferentes modos de vuelo. También permite calibrar los sensores, ajustar los PID, e incluso activar o desactivar ayudas en vuelo desde un pc con la interfaz gráfica Multiwii. La interfaz gráfica (GUI, Graphic User Interface) nos permite ver en tiempo real la orientación, la inclinación del dron y los datos enviados por la emisora. Se ha instalado la versión 2.4 de Multiwii que está compuesta por un núcleo “MultiWii.ino” que controla y accede a un conjunto de ficheros auxiliares de sufijo “.h” y “.cpp” que contienen el resto del código.

Figura 53 Panel de control en pc de Multiwii [42]

Page 36: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

36

Para la instalación del software Multiwii en la Arduino primero hay que descargar la versión 2.4 de la página web https://code.google.com/p/multiwii/. Se descargará un fichero comprimido con extensión rar que contiene dos carpetas, Multiwii y MultiWiiconf.

• En la carpeta MultiWiiconf encontramos la interfaz gráfica para calibrar y ajustar los PID.

• En la carpeta de Multiwii encontramos los archivos para la placa Arduino. El archivo MutiWii.ino es el que tendremos que subir a la placa Arduino pero antes debemos activar algunas líneas que están comentadas quitando las dos barras inclinadas al inicio de cada línea.

Las líneas de código que hay que activar son las siguientes: Tipo de quadcopter con motores en formación de X:

Parametrización de los límites de la emisora que hemos comprado:

Velocidad del programa:

Definimos la velocidad de comunicación del puerto I2C:

Definimos el giroscopio que queremos montar:

Definimos el magnetómetro escogido:

Después de estas modificaciones ya se puede cargar en el Arduino.

Figura 54 Muestra de archivos gestionados por Multiwii

Page 37: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

37

5.2 EMISORA Y RECEPTOR DE 8 CANALES

El dron se controla a través de la emisora de mando. Se ha elegido la emisora Turnigy 9X [43]. La emisora dispone de 9 canales. La pantalla LCD no se ve bien en el exterior. Para mejorar su visibilidad se añadió iluminación interior con un LED. El sistema de comunicación RX consta de dos componentes, la emisora que únicamente envía datos y el receptor que los interpreta. La frecuencia de la onda portadora es de 2.4 GHz, las ordenes se envían en forma de PPM (Pulse Position Modulation) enviando un tren de pulsos de los 9 canales. Se describe con más detalle en el apartado de lectura de la emisora.

Figura 55 Emisora TGY 9X

Figura 57 Receptor TGY de 8 canales

Figura 56 LCD con retroiluminación

Page 38: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

38

6. ESCANEANDO EL ENTORNO

Hemos llegado al punto donde se describe con más detalle el objetivo del proyecto. Recordemos que lo que queremos es que el dron sea capaz de evitar los obstáculos de modo autónomo cuando estemos navegando en el interior de un edificio. Esto no quiere decir que el dron pueda volar sin intervención del operador, sino que deberá ser capaz de frenarse antes de tocar con paredes o muebles aunque el operador le haya dado la orden de hacerlo, bien voluntaria o involuntariamente.

Figura 58 Lectura, análisis y envío.

El modo en que queremos realizar este objetivo se muestra en la figura y su funcionamiento es el siguiente.

• Dron en vuelo. • Lectura de distancias a los obstáculos. • Comparación de las distancias a los obstáculos con el umbral de

reacción. • Cálculo de la maniobra de evasión. • Envío al Arduino de vuelo de las correcciones necesarias para realizar la

maniobra de evasión. Así que lo primero que necesitamos es medir las distancias desde el dron hasta los obstáculos del entorno. Esto lo haremos por medio de sensores de medidas de distancias. A continuación se analizan diversos tipos.

Page 39: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

39

6.1 SENSOR ULTRASÓNICO HC-SR04

Rango 2 a 400 (cm) Resolución 0.3 cm Recorrer 1 cm 29.2 µs Ángulo detección 15 ̊Precio 0.67-4.5€

Este sensor es muy utilizado en electrónica domestica gracias a su bajo coste y a su alto rango de lectura. EL sensor emite una señal ultrasónica y mide el tiempo que tarda en regresar el eco. Conociendo la velocidad del sonido en el aire 343 m/s a nivel del mar podremos estimar la distancia hasta el obstáculo detectado. El sensor tiene una baja resolución angular ya que el haz emitido proporciona un eco en un ángulo de 15º. Esto es un inconveniente para hacer un mapeado preciso del entorno pero es una ventaja si utilizamos sensores estáticos. El rango de detección del sensor HCSR04 [44]se sitúa entre los 2 y los 400 cm. Este sensor tiene un coste entre 0.67€ y 4.5€ según el proveedor que lo suministre. Se ha escogido este sensor por la tasa de refresco entre detección y detección, pudiéndose realizar detecciones continuamente.

Este sensor dispone de 4 conexiones, Vcc para la alimentación de 5v, Trig para iniciar la lectura, Echo nos da el tiempo que transcurre desde el envío hasta la recepción de la onda acústica y GND que es el tierra, que irá conectado a 0V.

Figura 59 Sensor de ultrasonidos HCSR04

Page 40: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

40

Se ha construido una PCB para facilitar las conexiones de los sensores de ultrasonidos. Se ha diseñado una caja para alojar los sensores de ultrasonidos con el programa de diseño Solid Works. Se ha imprimido con una impresora 3d de la marca Anet [45] modelo A6.

6.1.1 ESTUDIO DEL SENSOR DE ULTRASONIDOS HC-SR04 Se ha analizado la señal de este sensor con un osciloscopio para ver como varía el ancho del pulso con la distancia. En la figura siguiente observamos que en el canal 1, en amarillo, se envía una orden de lectura al trigger. Por la parametrización del programa sabemos que tiene una duración de 10 �s. En el canal 2, en azul, tenemos el eco. El escalón de subida coincide con la emisión de la señal ultrasónica y el escalón de bajada coincide con la recepción del eco reflejado. En la gráfica se lee una distancia entre los dos escalones de 820 �s. La distancia al objeto se obtiene de la siguiente forma.

!���� !� " �# = �"��# ∗34000 �

�∗

1 �

10$��=

34 ∗ 10%& �

��∗ �"μ�#

Figura 60 chasis de sensores de ultrasonidos

Page 41: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

41

En el caso mostrado en la pantalla tenemos un objeto a una distancia aproximada de 15cm y el tiempo de retorno del eco es de 820 �s. Esto corresponde a una distancia de 28 cm pero esa distancia es la suma de la ida y la vuelta, por lo tanto la distancia real es la mitad de ese valor, 14cm. En la figura siguiente observamos la lectura con el objeto a una distancia de aproximadamente 1 m. El tiempo de retorno del eco es de 6300 µs, correspondiente a un recorrido total del pulso ultrasónico de 214 cm entre ida y vuelta, o sea 107 cm de distancia al obstáculo.

Figura 61 Lectura sensor HCSR04

Figura 62 Medición de 107 cm

Page 42: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

42

6.2 SENSOR DE DISTANCIA ÓPTICO SHARP GP2Y0A02YK0F Características del sensor de distancia óptico Sharp GP2Y0A02YK0F [46]:

Rango 20 a 150 (cm) Resolución 1 cm Recorrer 1 cm 3*10-10s

Precio De 3.7 a 44€

Inicialmente se pensó en elegir este sensor debido a la alta velocidad de la señal (luz). Sin embargo se ha descartado por tener una baja tasa de refresco debido a la necesidad de recargar un condensador entre medidas. Este sensor emite un haz de luz que se refleja en los objetos y es devuelto hacia el receptor. Éste nos proporciona en la salida una referencia de tensión analógica. Se deben emplear entradas analógicas de Arduino para leer el valor de distancia. El sensor está compuesto por un integrado combinado con un sensor PSD (position sensitive detector), un IRED (infrared emiting diode), y un circuito de tratamiento de la señal. El rango de tensión de entrada se sitúa entre 4,5-5,5 Volts con un consumo de corriente de 33 mA. Tiene una tasa de refresco de 80 ms. Este tipo de sensores no son aconsejables en exteriores ya que son muy sensibles a la luz directa y esta puede darnos lecturas incorrectas.

Figura 63 Sensor IR Sharp GP2Y0A02YK0F

Page 43: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

43

6.3 SENSOR DE DISTANCIA GARMIN LIDAR-LITE V3

La empresa Garmin especializada en dispositivos de GPS, ha adquirido recientemente la empresa PulsedLight Inc., una empresa que diseña y fabrica sensores LiDAR económicos [47]. Este tipo de sensores usan un haz de laser igual que los sensores de IR. Pero trabajan de modo diferente. Al igual que in IR, el LiDAR solo mide un punto. Su ventaja es que su rango de distancias es mucho mayor. El precio de estos sensores es muy superior a un sensor de ultrasonidos o a un sensor de IR. Además son bastante más pesados que los livianos sensores de ultrasonidos. Garmin nos ofrece un modelo relativamente asequible con buenas características, pudiendo llegar a las 500 lecturas por segundo.

Rango 2<4000 (cm) Resolución 1 cm Recorrer 1 cm 3*10-10s

Lecturas por segundo 500 Precio 100-150€

Figura 64 Sensor Garmin LiDAR Lite-v3

Page 44: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

44

7. ESQUEMA DE CONEXIÓN

El control de vuelo requerido para la evitación de obstáculos se puede hacer de diversas formas. Una de ellas es modificar el software de control de vuelo, de código abierto, que corre en el Arduino de vuelo. Pero este software tiene un tamaño disuasorio (alrededor de 10.000 líneas de código) y cualquier error en el programa daría al traste con el objetivo y sería de difícil solución. Por eso se optó por una solución alternativa. El programa de control de vuelo corre sin modificaciones en el Arduino de vuelo. Un segundo procesador, el Arduino Mega, recibe las órdenes de la emisora de control, gestiona las señales de los sensores de ultrasonidos, calcula las modificaciones de las órdenes de vuelo y añade estas modificaciones a las órdenes recibidas de la emisora, enviando las órdenes modificadas al Arduino de vuelo. Para el Arduino de vuelo y el programa de control de vuelo la operación es transparente. Reciben órdenes de vuelo como si vinieran directamente de la emisora, sólo que esas órdenes contienen las modificaciones necesarias para evitar los obstáculos. Se probó la sustitución del Arduino mega por un Arduino nano, más ligero, pero se desestimó por no tener suficientes interrupciones disponibles. Este es el esquema de conexión de placas. Por claridad el esquema está distribuido en dos figuras. Los sensores de ultrasonidos, no representados en la primera figura, están conectados directamente al Arduino mega tal como se ve en la siguiente imagen.

Figura 65 Interconexión entre placas receptora, de análisis y de vuelo.

Page 45: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

45

Figura 66 Esquema conexiones sensores a placa de análisis Arduino mega

Page 46: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

46

8. COMUNICACIÓN MEDIANTE BLUETOOTH

Se han usado dos conexiones bluetooth. Una para el Arduino de vuelo y otra para el Arduino mega. La Arduino de vuelo permite visualizar en el pc en tiempo real los parámetros de vuelo tales como el pitch, roll, yaw, posición de los joysticks, etc. También permite el ajuste de los PID. El bluetooth del Arduino de análisis permite modificar el programa de corrección de vuelo e implementar las modificaciones en el Arduino desde el pc sin cable. Estas modificaciones se realizaron muchas veces durante los ensayos en taller mientras se depuraba el programa. Hay que tener en cuenta que el programa de análisis y corrección se analizaba y modificaba en el pc, y tras cada modificación había que subirlo al Arduino de análisis para someterlo a ensayo. Los módulos de bluetooth utilizados son dos HC-05 [48]. El modulo utilizado en el Arduino de análisis requirió de la inserción de un condensador y 3 resistencias para un funcionamiento sin errores. La conexión entre el controlador de vuelo y el módulo bluetooth se representa en la siguiente figura:

La comunicación bluetooth se inicia creando un puerto serie adicional en la placa Arduino usando dos pines cualesquiera, de los cuales uno será para transmitir y el otro para recibir. El empleo de esos pines para esa finalidad debe declararse previamente en el programa.

Figura 67 Esquema conexionado bluetooth - Arduino de vuelo

Page 47: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

47

Si lo que queremos es reprogramar el Arduino, entonces solamente podremos hacerlo a través de los pines TX y RX, que son los puertos de programación por USB. En estos pines es donde realizamos la conexión por bluetooth, precisamente porque lo que nosotros perseguimos es reprogramar el Arduino inalámbricamente. El empleo de estos puertos para la comunicación por bluetooth no es compatible simultáneamente con el empleo de la entrada USB. En el caso de querer emplear la entrada USB hay que desconectar previamente el bluetooth de los pines TX y RX. La velocidad de comunicación entre el módulo bluetooth y el Arduino de análisis debe fijarse a 115200 baudios para subir un nuevo programa. A otras velocidades no es posible realizarlo, no lo permite el Arduino. En caso de utilizar un Arduino nano la velocidad de comunicación para reprogramación debe ser 57600 baudios (aprendido por prueba y error).

Figura 69 Conexión modulo bluetooth Arduino mega

Figura 68 Módulo bluetooth modificado

Page 48: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

48

9. CAPTURA DE DATOS El empleo de sensores consume tiempo de procesador, lo que ralentiza cualquier programa. Por ello es importante optimizar los programas para conseguir una tasa de refresco adecuada. Se emplean 4 sensores ultrasónicos que se conectan a la placa Arduino mega. A continuación se detallan los procedimientos empleados para la captura de datos. 9.1 LECTURA DE LOS SENSORES DE ULTRASONIDOS En este apartado se detallan los dos métodos empleados para capturas las lecturas de los sensores de ultrasonidos, con diferentes resultados en cuanto a velocidad de programa. 9.1.1 MEDICIÓN MEDIANTE LA FUNCIÓN PULSEIN() En la siguiente figura se muestra la conexión de un sensor. La función PULSEIN() nos devuelve el tiempo durante el cual el pin 5 del Arduino mega esta en 1 lógico.

Figura 70 Esquema de conexión de un sensor a la placa Arduino mega

Page 49: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

49

Las instrucciones para aplicar PULSEIN() son las siguientes:

Y así quedaron implementadas: Y el resultado de una medición se muestra en la siguiente figura: Figura 73 Captura de la señal echo y trigger

Figura 72 Lectura US mediante PulseIn()

Figura 71 Captura de pulseIn() de la página web Arduino [49]

Page 50: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

50

En esta medición el tiempo de retorno de la señal es de 780 µs que corresponde a 14 cm. Como la distancia máxima de detección es de 400 cm, tardaría 24 ms en hacer la lectura, y si tarda más de eso despreciamos la medida como fuera de rango. Durante este tiempo el procesador no puede realizar ninguna otra operación. Como tenemos 4 sensores, si hay que dejarle a cada uno 24 ms tendríamos un total de 96 ms. Es decir el tiempo de refresco del programa no podría ser mejor que cada 96 ms. Nuestro objetivo es mejorar el tiempo de refresco para ganar velocidad de reacción del dron. Vamos a ver que nos ofrece el próximo método de lectura. 9.1.2 MEDICIÓN MEDIANTE INTERRUPCIONES DE HARDWARE

Este método es más eficaz que el anterior, ya que no dejamos el Arduino esperando un cambio de estado del bit, sino que nos avisara cuando el bit cambie de estado y dejará lo que esté haciendo en ese momento para atender la llamada de la interrupción por hardware. Como desventaja, este método es más complicado de aplicar que la función PULSEIN(). Lo primero que vamos a hacer es ver en que consiste una interrupción que como su nombre indica, “interrumpe algo”. Pongamos como ejemplo una vivienda: Estamos cocinando y no tenemos las interrupciones activadas. Pican al timbre pero como no hemos acabado de cocinar no podemos atender la llamada. Una vez hemos terminado de cocinar acudimos al telefonillo pero es demasiado tarde, el cartero ya se ha marchado porque no lo hemos atendido cuando él nos lo ha solicitado. Ahora vamos a poner el mismo ejemplo pero con interrupciones activadas: Estamos cocinando con interrupciones activadas. Pican al timbre y dejamos lo que estamos cocinando para atender al telefonillo (es muy importante que el mensaje/ acción a realizar sea muy breve ya que dejamos de hacer todo lo demás para atender la llamada) Abrimos al cartero, colgamos el telefonillo y continuamos con lo que estábamos haciendo. Ahora bien, esto es un ejemplo muy básico. En las interrupciones el tiempo no transcurre, esto es debido a que el reloj interno es también una interrupción del sistema, generada de modo automático. En consecuencia no podremos saber con exactitud el tiempo que se ha dedicado a la interrupción. Hecha esta explicación previa, vamos a ver cómo hemos realizado las lecturas mediante interrupciones.

Page 51: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

51

Lo primero es entender las interrupciones, como activarlas y como utilizarlas.

...

Durante los ensayos se detectó que la falta de estabilidad de la fuente de 5V generaba lecturas erróneas por lo que es un punto a vigilar al implementar esta función. Primero de todo hay que saber que las placas Arduino tienen dos tipos de interrupción, la interrupción por pin y la interrupción por cambio de estado de pines. A continuación pasamos a detallar con más profundidad estos dos tipos de interrupción.

Figura 74 Captura parcial de la función ATTACHINTERRUPT() de la página [50]

Page 52: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

52

9.1.2.1 INTERRUPCIÓN POR PIN

Es un tipo de interrupción a través de la cual solo monitorizamos un pin en concreto. Es posible condicionar la interrupción para que solo reaccione a un tipo de excitación: • Flanco de subida • Flanco de bajada • 1 lógico • 0 lógico • Cambio, ya sea de 1 lógico a 0 lógico o viceversa. Arduino Mega Pin 2 3 21 20 19 18 Interrupción 0 1 2 3 4 5

Tabla 1 Interrupciones en el Arduino Mega

Primer paso, activar la interrupción por pin que vamos a utilizar.

Describimos la función anterior en la que solo entraremos en caso de producirse una interrupción.

• Se produce una interrupción del pin 3 asociado al eco del sensor de ultrasonidos frontal.

• Al haber entrado por primera vez en la interrupción, significa que se ha iniciado el pulso.

• Guardamos el tiempo actual en la variable t_inicio_1 que usaremos más adelante.

• Cambiamos el tipo de interrupción a flanco de bajada para que se active en cuanto finalice el pulso.

• La segunda vez que entramos en la interrupción, guardaremos en la variable t_fin_1 el tiempo actual.

• Cambiamos el tipo de interrupción a flanco de subida para el próximo pulso de lectura.

Figura 75 Activar interrupción Pin 3 Arduino Mega

Figura 76 Captura de la función (echo_1) del sensor de ultrasonidos frontal

Page 53: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

53

La función ATTACHINTERRUPT() es la que activa la interrupción. Dentro de la misma debemos especificar qué interrupción activamos. Si no sabemos el número de la interrupción que queremos activar, podemos usar la función DIGITALPINTOINTERRUPT() indicando cual es el pin sobre el que vamos a activar la interrupción por hardware. Lo siguiente es indicar a qué función debe saltar en caso de haber interrupción y lo último es indicar en qué caso queremos que se active la interrupción. 9.1.2.2 INTERRUPCIÓN POR CAMBIO DE ESTADO EN UN CONJUNTO

DE PINES

Las placas Arduino nos permiten hacer el seguimiento del cambio de estado de muchos pines. Normalmente no necesitaremos el seguimiento de todos ellos, por lo que se emplea un mascara para limitar la vigilancia al conjunto deseado. En el apartado de lectura de emisora lo veremos con más detalle.

Page 54: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

54

9.2 LECTURA DE LA EMISORA

Un dron en vuelo se controla desde una emisora. Para que las órdenes que se envían se traduzcan en cambios de velocidad de los rotores, primero el dron debe leer y traducir en órdenes la señal recibida. La emisora emplea una señal portadora de 2.4 GHz. El receptor debe seleccionar esta frecuencia entre todo el espectro de señales recibidas en cada instante y filtrar su contenido. Lo que va a recibir es una serie de tramas de 20 ms de duración total dentro de la cual hay unas cuantas señales pico. El primer pico corresponde al inicio de la trama y cada nuevo pico marca la separación entre canales. Al cabo de 20 ms hay un nuevo pico que indica el inicio de una nueva trama. La decodificación utiliza el flanco de subida de cada pico como separador entre canales. El flanco de bajada se desprecia. La señal enviada a cada canal es analógica y proporcional a su duración entre pico inicial y final. Los valores de cada canal se emiten consecutivamente, de forma que el final de la señal de un canal coincide con el inicio de la señal del canal siguiente. Cuando se termina el recorrido de todos los canales que conforman la trama, hay un periodo muerto de superior duración que sirve para sincronizar emisora y receptor. Tras el tiempo muerto del final de la trama empieza la emisión de una nueva trama.

Figura 77 Ejemplo de trama en modo PPM de una emisora de 7 canales [51]

Page 55: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

55

El receptor nos devuelve el ancho de pulso de cada canal en un pin diferente de entrada al Arduino. La lectura de cada canal la podemos hacer a través de dos métodos, igual que con los sensores de ultrasonidos, mediante la función PULSEIN() o con el uso de interrupciones. La función PULSEIN() que hemos visto anteriormente no nos sirve porque mantendría al procesador continuamente ocupado. Únicamente quedaría disponible el tiempo de relleno de la trama para alcanzar los 20 ms de ciclo. Por tanto es parece más adecuado gestionar las señales de la emisora mediante interrupciones. La placa Arduino está limitada a 6 pines de interrupción de lectura completa. Esto quiere decir que nos permite en cada uno de ellos seleccionar varios métodos de lectura de la interrupción:

• Flanco de subida • Flanco de bajada • 1 lógico • 0 lógico • Cambio, ya sea de 1 lógico a 0 lógico o viceversa.

Ya tenemos comprometidos 4 pines para la lectura de los sensores de ultrasonidos. Solamente nos quedan 2 pines para la lectura de datos de la emisora, de la cual necesitaremos 5 canales. Es insuficiente, pero afortunadamente el Arduino tiene otras posibilidades de interrupción. La única limitación es que solo se puede emplear la función CHANGE, cambio de estado.

Figura 78 Tabla de pines del controlador Mega2560 [36]

Page 56: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

56

Se ha usado el puerto K que incluye 8 pines, del A8 al A15, de los cuales se han empleado los 5 primeros. A continuación se detalla el uso de cada pin.

• A8 = Roll • A9 = Pitch • A10 = Throttle • A11 = Yaw • A12 = Kp (variable auxiliar de control)

El pin A12 se ha asignado a una variable de control auxiliar Kp que permite modificar otras variables en vuelo. Físicamente corresponde a un potenciómetro situado en la parte superior izquierda de la emisora. En la gráfica se puede ver a qué movimiento corresponde cada uno de los códigos.

Kp

Figura 79 Potenciómetro variable Kp

Figura 80 Movimientos de una aeronave [52]

Page 57: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

57

Por ejemplo el canal 2 en la figura llega al pin A9, el cual está bajo supervisión de CHANGE por el procesador. Cuando se produce la subida de señal marcada por la primera flecha, el Arduino detecta el cambio y anota el tiempo en ese instante. El procesador regresa entonces a las tareas que estaba ejecutando hasta que se produce la caída de la señal marcada por la segunda flecha, que también es detectada. La diferencia de tiempos entre ambos eventos nos proporciona el valor analógico enviado por la emisora. Esta operación se repite para cada uno de los pines asociados a las señales enviadas por la emisora, desde A8 hasta A12. Primero se activan las interrupciones, después se crea la máscara de lectura y luego se leen secuencialmente cuando corresponde al generarse una interrupción.

Figura 81 Captura de código lectura receptor RX

Page 58: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

58

10. ANÁLISIS DE DATOS

Una vez hemos hecho lecturas mediante los sensores de ultrasonidos toca el momento de analizar y evaluar los datos recibidos. El sensor de sonidos nos devuelve un ancho de pulso, este ancho equivale al tiempo transcurrido desde que el sensor envía una onda hasta que la recibe. Sabemos dos cosas, la primera que la velocidad del sonido a 20º C de temperatura y a la altura del mar es de 343,2 m/s y la segunda que la lectura del ancho de pulso será la suma de la ida más la vuelta de la onda. Por tanto la distancia se calcula así:

!���� !� =�� ℎ� ��� �����"�# ∗ 343.2"

��

#

2

Según los ensayos realizados se observó que la distancia medida por los sensores de ultrasonidos no se correspondía con la distancia medida con un flexómetro. Se habilitó un factor de corrección de valor 0.908 que ha quedado desactivado en la versión final porque no influye sensiblemente en el comportamiento del dron frente a los obstáculos, pero que se puede activar en cualquier momento. La velocidad del sonido aumenta ligeramente con la temperatura del aire, pero a los efectos de este proyecto el hecho es poco relevante y no se considera. 10.1 FILTROS DE DISTANCIA

Uno de los problemas que nos encontramos con cualquier sensor es la repetitividad de las lecturas. Los ensayos que hemos realizado con los sensores en posición estática nos dan ligeras variaciones junto con valores espurios repartidos aleatoriamente por ausencia de eco. Por ejemplo, estamos leyendo distancias con el dron posado en el suelo y el sensor delantero marca 30 cm. De vez en cuando aparece una ausencia de lectura por distancia fuera de rango que debemos filtrar, tal como se describe en el punto siguiente. 10.1.1 FILTRO DE MÁXIMOS Y MÍNIMOS

Éste filtro está creado para desestimar aquellas lecturas que pueden ser distancias superiores a la capacidad del sensor para el caso que no se reciba el eco. También hay que filtrar los valores negativos de la distancia por si por alguna razón no se han reseteado correctamente las variables.

Equation 1 Variación de la velocidad el sonido en el aire según la temperatura en ºC

Page 59: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

59

El programa sistemáticamente ignora las lecturas fuera del rango entre 0 cm y 300 cm. El sensor HC-SR04 es capaz de leer según el fabricante distancias de hasta 400 cm pero en las pruebas realizadas tenemos muchas pérdidas de eco por encima de 300 cm. 10.2 SUAVIZADO DE LAS LECTURAS

También se ha empleado un filtro de suavizado de señal para reducir el efecto de los valores erróneos. La desventaja de un filtro de suavizado es que aumenta el tiempo de respuesta frente a los obstáculos reales. Debido a la poca repetitividad de las lecturas de distancia ha sido necesario suavizar estas mismas realizando la media de las últimas 5 lecturas para así suavizar las lecturas erróneas. Para ello solo debemos guardar las últimas 4 lecturas para añadirla a la lectura actual. Esto nos ralentiza la respuesta pero es necesario para tener una diferencia entre distancias contenida.

10.3 REACCIÓN EN FUNCIÓN DE LA VELOCIDAD

Es posible reaccionar a la presencia de un obstáculo en función del tiempo estimado de colisión, lo cual requiere trabajar con velocidades en lugar de distancias. Se desestimó esta vía de trabajo por que las variaciones en las mediciones de distancia con tiempos de ciclo de programa pequeños, provocaban grandes variaciones de velocidad aparente que hacían difícil el control. Se optó por una reacción escalón a una distancia umbral del obstáculo que es mucho menos sensible a la detección de distancias anómalas. Proyectos similares encontrados en YouTube muestran en todos los casos correcciones de tipo escalón como el que proponemos. El esquema de conexión interna del dron y el tratamiento de las señales son prácticamente los mismos con uno y otro sistema de corrección. Solo cambia la variable

Figura 83 Suavizado con media móvil de las últimas 5 lecturas

Figura 82 Filtro de máximos y mínimos en el sensor delantero

Page 60: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

60

empleada como referencia, en un caso el tiempo esperado de colisión y en el otro la distancia al obstáculo en cm.

10.4 REACCIÓN EN FUNCIÓN DE LA DISTANCIA

Consiste en lo siguiente: Cuando el dron se acerca a un obstáculo fijo, por ejemplo una pared, a una distancia inferior a la distancia umbral, se da una orden a la controladora de vuelo para alejarse del obstáculo. En términos coloquiales seria como darle un “quite” al mando. Los pasos de una corrección son los siguientes:

• Dron en vuelo • El operador da las ordenes de vuelo desde la emisora • Los sensores leen las distancias a los obstáculos cada 25 ms • El Arduino de análisis compara en cada ciclo de programa las distancias

leídas con el umbral fijado, teniendo en cuenta la dirección de vuelo. • Se detecta un obstáculo por debajo del umbral de reacción • El Arduino de análisis detecta el evento y envía una orden puntual de

corrección al Arduino de vuelo • La orden de corrección se superpone a las órdenes de la emisora • El dron se aleja del obstáculo • El dron regresa a la condición de vigilancia sin corrección • Mientras la distancia sea superior a la distancia de umbral, el Arduino de

análisis no envía ninguna orden de corrección.

Figura 84 Fragmento de programa por tiempo estimado de colisión

Figura 85 Captura de la corrección escalón en función de “d_colision”

Page 61: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

61

RELOJ

LECTURA

DISTANCIAS

SI

RELOJ DE

ENVÍO

NO

SI

NO

Lectura de sensores distancia. Cada 25 ms

Diagrama de flujo del programa de corrección de vuelo en el

Arduino de análisis

Lectura de la emisora. Cada 20 ms

Análisis de distancias y comparación con umbral.

Cada 25 ms

Envío de órdenes de corrección a controladora de vuelo.

Cada 80 ms

Page 62: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

62

El diagrama de flujo anterior muestra 4 bloques de colores distintos. Correspondientes a las distintas tareas, las cuales no se ejecutan sincrónicamente. La lectura de la emisora no permite gestionar su velocidad. En cambio, los sensores de ultrasonidos si permiten controlar la frecuencia de lectura ya que si no excitamos el trigger no tenemos lectura. También tenemos control sobre la frecuencia de envío a la emisora. Las frecuencias son aproximadas ya que durante las interrupciones el reloj del programa queda suspendido y hay unos tiempos que no se computan. Hemos comprobado que la utilización de la misma frecuencia crea conflictos entre interrupciones. Durante el envío de instrucciones modificadas a la controladora se cancelan todas las interrupciones para evitar interferencias. Ya que si no detenemos las interrupciones el envió del pulso se ve alterado.

Page 63: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

63

11. PRUEBAS DE VUELO

Las pruebas que se han realizado con la reacción proporcional según la velocidad de aproximación no han tenido los resultados esperados. Sin embargo, las pruebas con la reacción escalonada, han salido satisfactoriamente. A continuación se muestra secuencia de imágenes del dron estático, objeto aproximándose y reacción de evasión.

Figura 86 Objeto fuera de zona de reacción

Figura 87 Objeto aproximándose a zona de reacción

Figura 88 Objeto en zona de reacción

Page 64: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

64

Figura 89 Reacción de evasión para alejarse del objeto

Figura 90 Dron alejándose del objeto

Figura 91 Prototipo de dron con los sensores de ultrasonidos

Page 65: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

65

12. DISEÑO E IMPRESIÓN DE PIEZAS

Para alojar los sensores se optó por diseñar un chasis. El programa utilizado es SolidWorks [53], un programa de diseño en 3 dimensiones. El diseño del chasis se realizó pensando que en un futuro se pueda equipar al dron con un quinto sensor de ultrasonidos colocado en la parte inferior. Este sensor leerá la altura respecto al suelo para poder mantenerla constante. Tanto el chasis de los sensores como las patas del dron se han imprimido con PLA (Ácido PoliLáctico) [54]. Es una material biodegradable que se obtiene a partir de almidón de maíz (EE.UU.), de yuca o mandioca (Asia), o de caña de azúcar (Resto del mundo). Su principal uso es para hacer envases.

Figura 92 Diseño del chasis de sensores de ultrasonidos

Figura 93 Diseño de la tapa inferior para alojar un quinto sensor

Page 66: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

66

Figura 94 Vistas del chasis de sensores de ultrasonidos impreso con PLA

Figura 95 Chasis de los sensores montado en el dron

Page 67: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

67

Las patas del dron han sido otro elemento que se ha tenido que cambiar porque las patas originales no tenían suficiente altura como para equipar los sensores de ultrasonidos en la panza del dron. Se decidió montar los sensores en la panza del dron para equilibrar los pesos porque si se ponían en la parte superior subía el centro de gravedad y hacía el dron más inestable. Un primer intento de alargar las patas con tornillos más largos no dio buen resultado por que estos se doblaban en los aterrizajes.

Figura 96 Diseño de la pata impresa en PLA

Figura 97 Impresión 3d de una de las patas

Page 68: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

68

13. PRESUPUESTO En este apartado se tienen en cuenta los gastos asociados al producto. Se ha dividido en 3 partes, el coste del personal, el coste de los materiales, y el coste de las impresiones 3D.

13.1 COSTE PERSONAL En este apartado se detalla el coste personal, el precio/hora y las horas dedicadas en cada una de las partes de este proyecto.

Coste personal Tiempo (h) Coste unitario €/h Precio total €

Montaje 40 30 1200

Desarrollo 260 30 7800

Ensayos 200 30 6000

Total 15000

Page 69: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

69

13.2 COSTE MATERIAL

Grupo Producto Referencia Unidades Precio Precio

unitario total

Kit Motores

KingKong hélices 5x4 1 45,91 45,91

2204-2300kV

Batería

Turnigy 2650 mAh 3 11,8 35,4

20-30C 3S

Parte Zippy 1800 mAh 1 12,42 12,42

de potencia 9,9C 5C

y Avisador de batería

HobbyKing LiPo 1 2,47 2,47

radiocontrol checker 2S-8S

Cargador DC IMAX B6 5A 1 16,95 16,95

Conectores Varios 1 18 18

Emisora

Turnigy 9X 9Ch 1 73,2 73,2

Receptor 8 canales

LCD LCD iluminado 1 14,74 14,74

Protector hélice Clase 250 Racer 2 4,12 8,24

Chasis Dardo 250 FPV 1 37,85 37,85

Arduino nano Atmega328P 1 3,75 3,75

Controladora Giroscopio GY-521 1 8,99 8,99

Módulo BT

kkmon bluetooth 1 8,39 8,39

HC-05

Brújula HMC5883L 1 5,99 5,99

PCB

Placa circuito 1 1,5 1,5

perforado

Arduino Mega AtMega2560 1 11,99 11,99

Ultrasonidos HC-SR04 4 2,25 9

Control Módulo BT

kkmon bluetooth 1 8,39 8,39

Obstáculos HC-05

PCB

Placa circuito 1 1,5 1,5

perforado

Cables Cables y varios 1 25 25

Total 349,68

Arduino nano Atmega328P 2 3,75 7,5

Arduino Mega AtMega2560 1 11,99 11,99

Material Ultrasonidos HC-SR04 2 2,25 4,5

averiado en Giroscopio GY-521 1 8,99 8,99

ensayos Batería

Turnigy 2200 mAh 2 13,29 26,58

25-35C 3S

Total 409,24

invertido

Page 70: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

70

13.3 COSTE IMPRESIÓN

Producto Impresión 3D (minutos) Coste unitario €/min Precio

total

Patas dron 120 0,085 10,2

Chasis 150 0,085 12,75

sensores

Total

22,95

13.4 COSTE FINAL PROTOTIPO

Precio €

Materiales 409,24

Coste personal 15000

Coste impresión 22,95

Total 15432,19

Page 71: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

71

14. CONCLUSIONES

Este proyecto demuestra la factibilidad de que un dron vuele en espacios reducidos mientras evita los obstáculos de modo automático sin ayuda de GPS. El dispositivo se ha construido a base de elementos electrónicos comerciales de bajo coste: sensores ultrasónicos y procesadores Arduino. Para ello se han realizado los programas de control en AVR LIBC, lenguaje de programación de Arduino derivado de C++. Se han analizado diversos tipos de sensores, con la conclusión de que la mejor relación calidad/precio la ofrecen hoy por hoy los sensores ultrasónicos. Los sensores laser son más rápidos y más precisos, pero por el momento son bastante más caros y más pesados. Este último factor es crítico cuando hay que instalar varios de ellos en un dron de tamaño medio. Los sensores ultrasónicos empleados, por último, pagan su buena relación calidad/precio con una respuesta imperfecta frente a los tejidos, los cuales son malos reflectores de las ondas de sonido. Esto puede ser un problema con la ropa, las cortinas, las personas, etc. También reaccionan mal frente a paredes que no son perpendiculares al haz sónico. El programa de control, genera una reacción escalón cuando el dron se aproxima a un obstáculo por debajo de la distancia umbral. Esta respuesta simple admite variantes o mejoras más sofisticadas que puede ser objeto de futuras líneas de desarrollo como se detalla en el punto siguiente. En resumen, se han logrado los siguientes objetivos.

• Mantener el dron bastante estable en ausencia de GPS. • Una respuesta satisfactoria frente a una colisión inminente, siempre que el objeto

presente un plano perpendicular o casi perpendicular al haz de ultrasonidos. • Integrar la lectura de los sensores, la lectura del receptor de radio, el envío al

controlador de vuelo y, la comunicación bluetooth en una sola placa Arduino. • Construir un chasis para alojar los sensores que permite una instalación más

limpia del conjunto simplificando así la cantidad de cables a usar. • Gestionar las señales de los sensores de ultrasonidos mediante interrupciones

de programa. El objetivo último debería ser la conducción completamente autónoma, aunque esto por el momento queda lejos de las posibilidades y la potencia de cálculo embarcado en una nave de pequeño tamaño. La sustitución de la placa Arduino mega, por una más ligera tipo Arduino nano, se ha revelado no factible por la limitación del número de interrupciones disponibles.

Page 72: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

72

Para la realización de proyectos de este estilo ofrecen muchas más posibilidades los drones con componentes adquiridos por separado a partir de un kit básico. Los drones comerciales completos listos para volar, ofrecen muchas menos posibilidades de manipulación, modificación y acceso a las señales.

En internet se encuentran muchas ayudas para estos proyectos bajo la forma de videos, tutoriales, códigos, foros, etc. En la bibliografía se citan algunas de estas direcciones que pueden ser de ayuda.

Page 73: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

73

15. FUTURAS LÍNEAS DE TRABAJO

Dotar al dron de sensores de distancia al suelo y al techo. Para volar en entornos de altura reducida. Mejorar el mapeado del entorno mediante matrices con mayor número de sensores. Una matriz de sensores rotativa podría dar un mapa de 360º con solamente dos o cuatro sensores. Sustitución de los sensores de ultrasonidos por sensores LiDAR, que son actualmente lo más avanzado en mapeados de entorno. Por el momento son pesados y demasiado caros. Emplear visión por ordenador para analizar imágenes tomadas por cámaras de video y deducir a partir de las imágenes el mapa 3d del entorno. Eso permitiría al dron la navegación con un nivel de conocimiento del entorno similar al de un ser vivo. Emplear componentes electrónicos de menor tamaño para dotar de sistemas de mapeado del entorno a drones cada vez más pequeños. Modificar el programa para que el dron reaccione en función del tiempo estimado de colisión, en lugar de la distancia al obstáculo. Implementar un lazo de control más sofisticado que una función escalón. Por ejemplo, una reducción progresiva de la velocidad a medida que el dron se acerca al obstáculo.

Page 74: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

74

BIBLIOGRAFÍA

[1] « Drone | Wikipedia, la enciclopedia libre.» [En línea]. Disponible en: https://en.wikipedia.org/wiki/Drone . [Accedido: 12-Octubre-2017].

[2] « Vehículo aéreo no tripulado - Wikipedia, la enciclopedia libre.» [En línea]. Disponible

en: https://es.wikipedia.org/wiki/Sensor_inercial . [Accedido: 02-Marzo-2017]. [3] « Cómo son los misiles Tomahawk, el arma de precisión mortal que Estados Unidos

usó para atacar una base aérea en Siria | BBC .» [En línea]. Disponible en: http://www.bbc.com/mundo/noticias-39527593 . [Accedido: 14-Octubre-2017].

[4] « Vehículo aéreo de combate no tripulado | Wikipedia, la enciclopedia libre.» [En línea]. Disponible en: https://es.wikipedia.org/wiki/Veh%C3%ADculo_a%C3%A9reo_de_combate_no_tripulado . [Accedido: 2-Marzo-2017].

[5] « General Atomics MQ-1 Predator - Wikipedia, la enciclopedia libre.» [En línea].

Disponible a: https://en.wikipedia.org/wiki/General_Atomics_MQ-1_Predator . [Accedido: 02-Marzo-2017].

[6] «Llega donde no ha llegado nadie | Cinemacopter .» [En línea]. Disponible en:

https://www.cinemacopter.com/ . [Accedido: 14-Octubre-2017].

[7] « Whelcome aboard tiny whoop TM | Tinywhoop » [En línea]. Disponible en:

https://www.tinywhoop.com/ . [Accedido: 12-Octubre-2017]. [8] « First-person view (radio control) - Wikipedia, the free encyclopedia.» [En línea].

Disponible en: https://en.wikipedia.org/wiki/First-person_view_(radio_control) . [Accedido: 02-Abril-2017].

[9] «The future of possible | DJI .» [En línea]. Disponible en: https://www.dji.com/es .

[Accedido: 16-Octubre-2017]. [10] «GoPro Karma | GoPro» [En línea]. Disponible en:

https://es.shop.gopro.com/EMEA/karma . [Accedido: 16-Octubre-2017].

Page 75: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

75

[11] «Yuneec Typhoon H Pro | Yuneec» [En línea]. Disponible en: https://www.yuneec.com/es_ES/drones-con-camara/typhoon-h/datos.html . [Accedido: 16-Octubre-2017].

[12] «Self-flying drone dips, darts and dives through trees at 30 mph | MIT.edu .» [En

línea]. Disponible en: http://www.csail.mit.edu/drone_flies_through_forest_at_30_mph . [Accedido: 14-Octubre-2017].

[13] «5 Amazing Autonomous Drones YOU MUST SEE | Youtube .» [En línea].

Disponible en: https://www.youtube.com/watch?v=8IwwlyekvbM . [Accedido: 14-Octubre-2017].

[14] « Dron Passport de Hover Camera » [En línea]. Disponible en:

https://www.apple.com/es/shop/product/HL172ZM/A/dron-passport-de-hover-camera . [Accedido: 17-Octubre-2017].

[15] « TR-60: el sorprendente tiltrotor coreano | Todrone » [En línea]. Disponible en: http://www.todrone.com/tr-60-tiltrotor-corea/ . [Accedido: 12-Octubre-2017].

[16] « Bell-Boeing V-22 Osprey - Wikipedia, the free encyclopedia.» [En línea].

Disponible en: https://es.wikipedia.org/wiki/Bell-Boeing_V-22_Osprey . [Accedido: 02-Abril-2017].

[17] «IAI Unveils the Ghost – a Miniature UAV For Special Operations | dev.defense-

update .» [En línea]. Disponible en: http://dev.defense-update.com/20110808_ghost.html . [Accedido: 14-Octubre-2017].

[18] «Este dron de tres hélices de Xiaomi nos adelanta una potente cámara de acción:

4K a 60 imágenes por segundo | Cinemacopter .» [En línea]. Disponible en: https://www.xataka.com/drones/este-dron-de-tres-helices-de-xiaomi-nos-adelanta-una-potente-camara-de-accion-4k-a-60-imagenes-por-segundo . [Accedido: 14-Octubre-2017].

[19] «DJI Mavic Pro | DJI» [En línea]. Disponible en:

https://store.dji.com/es/product/mavic-pro . [Accedido: 16-Octubre-2017].

[20] « Whelcome aboard tiny whoop TM | Tinywhoop » [En línea]. Disponible en:

https://www.tinywhoop.com/ . [Accedido: 12-Octubre-2017].

Page 76: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

76

[21] « Chinese Firm Developing Self-Flying, Passenger Carrying Megadrone For Use As a Smart Taxi [Video] – aerodynamic media.» [En línea]. Disponible en: http://aerodynamicmedia.com/megadrone/ . [Accedido: 02-Abril-2017].

[22] «Eagle Pro 6 Rotor Wifi Drone W- Camera | 2salesnorth .» [En línea]. Disponible

en: https://2salesnorth.com/products/eagle-pro-6-rotor-wifi-drone-w-camera . [Accedido: 14-Octubre-2017].

[23] «Top 3 Tested Cargo Drones | milkman.it .» [En línea]. Disponible en:

https://www.milkman.it/top-3-tested-cargo-drones/ . [Accedido: 14-Octubre-2017].

[24] « ESC's | Quadruino » [En línea]. Disponible en: http://www.quadruino.com/guia-

2/materiales-necesarios-1/esc . [Accedido: 12-Octubre-2017]. [25] «Dardo 250 FPV Drone w / distribución de alimentación, limpio y sucio e

iluminación LED | Hobbyking » [En línea]. Disponible en: https://hobbyking.com/es_es/dart-250-fpv-with-power-distribution-clean-and-dirty-and-led-illumination.html. [Accedido: 23- Febrero -2017].

[26] «Brushless RC Motors | hooked-onre-airplanes .» [En línea]. Disponible en:

http://www.hooked-on-rc-airplanes.com/brushless-rc-motors.html . [Accedido: 14-Octubre-2017].

[27] «KINGKONG Fuerza 200 4 x 2204-2300kv w / hélices 5x4 (CW y CCW) | Amazon

» [En línea]. Disponible en: https://www.amazon.es/HobbyKing-KINGKONG-2204-2300kv-Propellers-Booole/dp/B01EE0WELY. [Accedido: 24- Febrero -2017].

[28] «Brushless motors - how they work and what the numbers mean | dronetest .»

[En línea]. Disponible en: http://www.dronetrest.com/t/brushless-motors-how-they-work-and-what-the-numbers-mean/564 . [Accedido: 14-Octubre-2017].

[29] « Motores Brushless | Rodrigo Alcoberro » [En línea]. Disponible en: http://slideplayer.es/slide/10367903/ . [Accedido: 12-Octubre-2017].

[30] « BLHeliSuite.» [En línea]. Disponible en: https://blhelisuite.wordpress.com/ .

[Accedido: 02-Abril-2017].

Page 77: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

77

[31] «Todo sobre las baterias LiPo | Bricogeek .» [En línea]. Disponible en: http://blog.bricogeek.com/noticias/modelismo/todo-sobre-las-baterias-lipo/ . [Accedido: 14-Octubre-2017].

[32] «Turnigy 2200mAh 3S Lipo 25C Paquete| Hobbyking » [En línea]. Disponible en:

https://hobbyking.com/en_us/turnigy-2200mah-3s-25c-lipo-pack.html. [Accedido: 23- Febrero -2017].

[33] «Turnigy 2650mAh 3S 20C Lipo Pack | Hobbyking » [En línea]. Disponible en:

https://hobbyking.com/en_us/turnigy-2650mah-3s-20c-lipo-pack.html. [Accedido: 27-Agosto-2017].

[34] «HobbyKing™ Lipo Voltage Checker (2S~8S) | Hobbyking » [En línea]. Disponible en: https://hobbyking.com/en_us/hobbykingtm-lipo-voltage-checker-2s-8s.html. [Accedido: 27- Agosto -2017].

[35] « Arduino Nano - Arduino.» [En línea]. Disponible en:

https://store.arduino.cc/arduino-nano . [Accedido: 02-Abril-2017]. [36] «Atmega328 - Wikipedia, la enciclopedia libre.» [En línea]. Disponible en:

https://es.wikipedia.org/wiki/Atmega328 [Accedido: 28-Marzo-2017]. [37] «MPU-6050 | InvenSense.» [En línea]. Disponible en:

http://www.invensense.com/products/motion-tracking/6-axis/mpu-6050/ . [Accedido: 16-Marzo-2017].

[38] «SunFounder Digital Compass HMC5883L Module for Arduino and Raspberry Pi

| Amazon » [En línea]. Disponible en: https://www.amazon.es/gp/product/B0151G64RU/ref=oh_aui_detailpage_o01_s00?ie=UTF8&psc=1. [Accedido: 03-Marzo-2017].

[39] «BMP180 Barometric Pressure/Temperature/Altitude Sensor- 5V ready -

adafruit.» [En línea]. Disponible en: https://www.adafruit.com/product/1603 [Accedido: 28-Marzo-2017].

[40] «Electronics made easy | FRITZING » [En línea]. Disponible en:

http://fritzing.org/home/ [Accedido: 18-Septiembre-2017].

Page 78: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

78

[41] «KINGKONG Micro CC3D Flight Controller | Hobbyking » [En línea]. Disponible en: https://hobbyking.com/en_us/micro-cc3d-fc.html?___store=en_us . [Accedido: 27- Agosto -2017].

[42] «MultiWii is a general purpose free open source project to control flying RC

models. » [En línea]. Disponible en: http://www.multiwii.com/wiki/index.php?title=Main_Page [Accedido: 16-Junio-2017].

[43] «Turnigy 9X transmisor 9Ch w / módulo y receptor de 8 canales (Modo 2) (v2

Firmware) | Hobbyking » [En línea]. Disponible en: https://hobbyking.com/en_us/turnigy-9x-9ch-transmitter-w-module-8ch-receiver-mode-2-v2-firmware.html. [Accedido: 24- Febrero -2017].

[44] «Sensor Ultrasonidos, Elegoo HC-SR04 Kits de Sensores de Distancia por

Ultrasonidos para Arduino UNO MEGA2560 Raspberry Pi, Hoja de Datos Disponible para Descargar | Amazon » [En línea]. Disponible en: https://www.amazon.es/gp/product/B06W9JD4X2/ref=oh_aui_detailpage_o01_s00?ie=UTF8&psc=1. [Accedido: 23-Febrero-2017].

[45] «Anet A6 Kit de Impresora 3D de Escritorio - Enchufe US Negro - Gearbest»

[En línea]. Disponible en: https://es.gearbest.com/3d-printers-3d-printer-kits/pp_428455.html [Accedido: 28-Marzo-2017].

[46] «Infrared Proximity Sensor - Sharp GP2Y0A21YK » [En línea]. Disponible en:

https://www.sparkfun.com/products/242 [Accedido: 23-Marzo-2017]. [47] «Tipos de LIDAR » [En línea]. Disponible en:

http://desktop.arcgis.com/es/arcmap/10.3/manage-data/las-dataset/types-of-lidar.htm [Accedido: 25-Septiembre-2017].

[48] «KKmoon Wireless Bluetooth Maestro y Esclavo HC-05 del módulo de

transceptor para Arduino ARM DSP PIC | Amazon » [En línea]. Disponible en: https://www.amazon.es/gp/product/B00ZEKREXM/ref=oh_aui_detailpage_o07_s00?ie=UTF8&psc=1. [Accedido: 6-Marzo-2017].

[49] «pulseIn()| Arduino.cc » [En línea]. Disponible en:

https://www.arduino.cc/en/Reference/PulseIn [Accedido: 18-Septiembre-2017].

[50] «attachInterrupt() | Arduino.cc » [En línea]. Disponible en:

https://www.arduino.cc/en/Reference/AttachInterrupt . [Accedido: 27- Agosto -2017].

Page 79: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

79

[51] « Proyecto Cuadricoptero UAV: Problema con receptor de emisora RC |

Arduino.cc. » [En línea]. Disponible en: http://forum.arduino.cc/index.php?topic=70877.15 [Accedido: 16-Junio-2017].

[52] «Aircraft rotations | Nasa .» [En línea]. Disponible en:

https://www.grc.nasa.gov/www/k-12/airplane/rotations.html . [Accedido: 14-Octubre-2017].

[53] «Software de diseño CAD en 3D | SOLIDWORKS » [En línea]. Disponible en:

http://www.solidworks.es/ [Accedido: 23-Septiembre-2017]. [54] «Ácido poliláctico | Wikipedia » [En línea]. Disponible en:

https://es.wikipedia.org/wiki/%C3%81cido_polil%C3%A1ctico [Accedido: 16-Septiembre-2017].

[55] «Conectores de oro de 4 mm de 10 pares (20pc) | Hobbyking» [En línea].

Disponible en: https://hobbyking.com/en_us/4mm-gold-connectors-10-pairs-20pc.html . [Accedido: 10-Febrero-2017].

[56] «Protección de hélice para la Clase 250 Racer (5 pulgadas) Conjunto de 4 |

Hobbyking » [En línea]. Disponible en: https://hobbyking.com/es_es/propeller-guards-for-the-250-class-racer-5inch-set-of-4.html. [Accedido: 23- Febrero -2017].

[57] «90 grados del jefe del Pin 1 x 30 Pin paso de 2,54 mm (5PCS) | Hobbyking »

[En línea]. Disponible en: https://hobbyking.com/en_us/90-degree-pin-header-1-x-30-pin-2-54mm-pitch-5pcs.html. [Accedido: 24- Febrero -2017].

[58] «Amortiguación de la vibración de la bola (65 g) (Bolsa de 8) | Hobbyking » [En

línea]. Disponible en: https://hobbyking.com/en_us/vibration-damping-ball-65g-bag-of-8.html. [Accedido: 24- Febrero -2017].

[59] «XT60U (XT60 Upgrade) masculino y femenino (5 piezas cada uno) | Hobbyking

» [En línea]. Disponible en: https://hobbyking.com/es_es/xt60u-xt60-upgrade-male-female-5-pieces-each.html. [Accedido: 24- Febrero -2017].

[60] «XT60plus con aislante tapa del extremo (masculino y femenino) (5set / bolsa) |

Hobbyking » [En línea]. Disponible en: https://hobbyking.com/en_us/new-xt60plus-with-insulating-end-cap-5set-bag.html. [Accedido: 24- Febrero -2017].

Page 80: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

80

[61] «MR30 - 2.0mm Pin 3 Motor de ESC Conector (30A) Hombre / Mujer (5 sistemas / bolsa) | Hobbyking » [En línea]. Disponible en: https://hobbyking.com/en_us/mr30-2-0mm-3pins-connector-male-female-5sets-per-bag.html. [Accedido: 24- Febrero -2017].

[62] «Paquete ZIPPY Flightmax 1800mAh 9.9V 5C LiFePo4 TX| Hobbyking » [En

línea]. Disponible en: https://hobbyking.com/en_us/zippy-flightmax-1800mah-9-9v-5c-lifepo4-tx-pack.html. [Accedido: 23- Febrero -2017].

[63] «XCSOURCE® Juego de 5pcs Tarjeta Micro Controlador Mini USB Nano V3.0

ATmega328P 5V 16M para Arduino TE359 | Amazon » [En línea]. Disponible en: https://www.amazon.es/gp/product/B015MGHH6Q/ref=oh_aui_detailpage_o06_s00?ie=UTF8&psc=1. [Accedido: 16-Marzo-2017].

[64] «XCSOURCE® Mega 2560 R3 + Cable USB / Mega 2560 R3 Atmega2560-16AU

Tarjeta del módulo 2012 Versión para Arduino TE629 | Amazon » [En línea]. Disponible en: https://www.amazon.es/gp/product/B01N51Y3EJ/ref=oh_aui_detailpage_o00_s00?ie=UTF8&psc=1. [Accedido: 17-Marzo-2017].

[65] «Elegoo 120 Piezas de Cable DuPont, 40 Pines Macho-Hembra, 40 Pines

Macho-Macho, 40 Pines Hembra-Hembra, Cables Puente para Placas Prototipo (Protoboard) para Arduino, Kit de Cables para Arduino | Amazon » [En línea]. Disponible en: https://www.amazon.es/gp/product/B01NGTXASZ/ref=oh_aui_detailpage_o01_s00?ie=UTF8&psc=1. [Accedido: 6-Marzo-2017].

[66] «Elegoo Conjunto Mas Completo y Avanzado de Iniciación a Arduino MEGA

2560 con Guías Tutorial en Español y Conjunto de Arduino con Placa Controladora MEGA 2560, LCD1602, Servomotor, Motor paso a Paso, Arduino Mega Kit Starter Kit | Amazon » [En línea]. Disponible en: https://www.amazon.es/gp/product/B01MQPT9OD/ref=oh_aui_detailpage_o02_s00?ie=UTF8&psc=1. [Accedido: 16-Marzo-2017].

[67] «WINGONEER 5Pcs/Lot Prototipado Placa De Circuito. 5 X 7 Cm hágalo usted

mismo prototipo Matrix stripboard Pcb | Amazon » [En línea]. Disponible en: https://www.amazon.es/WINGONEER-Prototipado-Circuito-prototipo-stripboard/dp/B01CYL6CAY/ref=sr_1_10?s=electronics&ie=UTF8&qid=1508182780&sr=1-10&keywords=pcb. [Accedido: 16-Marzo-2017].

[68] «ArduPilot | Software de control de vuelo abierto » [En línea]. Disponible en:

http://ardupilot.org/ardupilot/ [Accedido: 23-Febrero-2017].

Page 81: Memoria-TFG dron con evasion de obstaculos 2...Los drones tienen cada vez más aplicaciones y algunos de ellos requieren la navegación en espacios reducidos o interiores de edificios

Diseño y control de un dron con evasión de obstáculos Julio Lago Canadas

81

[69] «Aduino | Software IDE » [En línea]. Disponible en: https://www.arduino.cc/en/Main/OldSoftwareReleases [Accedido: 15-Febrero-2017].

[70] «Medir distancia con Arduino y sensor de ultrasonidos HC-SR04 » [En línea].

Disponible en: https://www.luisllamas.es/medir-distancia-con-arduino-y-sensor-de-ultrasonidos-hc-sr04/ [Accedido: 15-Febrero-2017].

[71] «La electrónica de vuelo para una aeronave no tripulada. » [En línea]. Disponible

en: https://vueloartificial.com/introduccion/primeros-pasos/la-electronica-de-vuelo/ [Accedido: 29-Julio-2017].

[72] «Simple Pin Change Interrupt on all pins » [En línea]. Disponible en:

https://playground.arduino.cc/Main/PinChangeInterrupt [Accedido: 12-Marzo-2017]. [73] «Motores para drones. Nociones básicas. » [En línea]. Disponible en:

https://maxterdrone.com/es/blog/motores-para-drones-que-necesitas-saber-n18/ [Accedido: 18-Febrero-2017].

[74] «Garmin Resurrects the Dirt-Cheap LiDAR: LiDAR-Lite V3 Will Cost $150 » [En

línea]. Disponible en: https://www.spar3d.com/news/garmin-resurrects-dirt-cheap-lidar-lidar-lite-3-will-cost-150/ [Accedido: 25-Septiembre-2017].

[75] «LIDAR-Lite v3 » [En línea]. Disponible en: https://buy.garmin.com/en-

US/US/p/557294 [Accedido: 25-Septiembre-2017]. [76] «Geeetech 3D Filament PLA, Filamento 3D PLA, 3D PLA Filament 1.75mm 1KG,

High Quality Reliable 3D Printing Filament For 3D Printer, Color: gold » [En línea]. Disponible en: https://www.amazon.es/BQ-05BQFIL023-Filamento-para-impresi%C3%B3n/dp/B01KI22750

[77] «Arduino Playground - MPU-6050.» [En línea]. Disponible en:

http://playground.arduino.cc/Main/MPU-6050 . [Accedido: 01-jul-2017].