Guida al montaggio di Carbon Aeronautics Quadcopter
Drone quadricottero costruito da zero che insegna aeronautica, elettronica e programmazione
Licenza
MIT
Guida al montaggio
1. Per iniziare
Configura il microcontrollore Teensy 4.0. Installa Arduino IDE e Teensyduino. Salda i pin dei connettori a pettine.
1.1 Installa gli strumenti di sviluppo
Installa Teensy Loader, Arduino IDE 1.8.16 e Teensyduino 1.55
1.2 Prova il microcontrollore
Collega il Teensy 4.0 tramite USB, carica e prova lo sketch blink
1.3 Salda i pin header
Salda i pin header maschi su Teensy 4.0 e sulle schede breakout MPU-6050 e BMP280
1.4 Costruisci il circuito dei LED
Collega il LED verde al pin 6 e il LED rosso al pin 5 con resistenze sulla breadboard
1.5 Costruisci il partitore di tensione
Collega la LiPo 2S tramite un partitore di tensione al pin analogico 15 per il monitoraggio della batteria
2. Configurazione dei sensori
Collega e programma il giroscopio MPU-6050 via I2C. Calibra gli offset del giroscopio.
2.1 Collega l'MPU-6050 via I2C
Collega SDA/SCL al Teensy. Configura l'I2C a 400 kHz.
2.2 Leggi i dati del giroscopio
Configura i registri del giroscopio, leggi i dati grezzi, convertili in gradi/secondo per rollio/beccheggio/imbardata
2.3 Calibra il giroscopio
Registra 2000 misure all'avvio, calcola l'offset medio, sottrailo dalle letture
3. Controllo di motori e ricevitore
Prova il controllo di ESC/motori via PWM, collega il ricevitore PPM, comanda i motori tramite il Teensy.
3.1 Prova l'ESC direttamente
Collega l'ESC al canale 3 del ricevitore in modalità PWM. Verifica il controllo del motore dal trasmettitore.
3.2 Collega il ricevitore PPM
Collega l'uscita PPM del ricevitore FS-iA6B al pin 14 del Teensy. Leggi 6 canali con la libreria PulsePosition.
3.3 Controlla il motore con il Teensy
Imposta il PWM a 250 Hz, risoluzione a 12 bit. Mappa il gas del ricevitore sull'uscita del motore.
4. Gestione della batteria
Costruisci il circuito dell'interruttore di alimentazione high-side, aggiungi la misura della tensione, implementa il monitoraggio della batteria.
4.1 Costruisci il circuito dell'interruttore di alimentazione
Cabla l'interruttore high-side BTS50080-1TMB con un interruttore a slitta per il comando ON/OFF
4.2 Aggiungi la misura della corrente
Cabla la misura della tensione per la misura della corrente e il monitoraggio della percentuale di batteria
4.3 Implementa il monitoraggio della batteria
Programma l'avviso LED di batteria scarica (LED rosso a <=30%)
5. Costruzione del quadricottero
Montaggio fisico: monta ESC, motori, eliche, ricevitore e batterie, salda l'elettronica del telaio PCB.
5.1 Monta gli ESC sul telaio inferiore
Fissa 4 ESC al telaio PCB inferiore, installa 4 distanziali del telaio con viti M3x6mm
5.2 Monta motori ed eliche
Fissa 4 motori con viti M2x4mm, installa le eliche CW/CCW con viti M2x8mm
5.3 Installa ricevitore e batteria
Monta il ricevitore con una fascetta, fissa la batteria con una cinghia, proteggi i cavi
5.4 Salda l'elettronica del telaio superiore
Salda header, interruttori, resistenze, diodi, LED e connettore XT60 sul PCB superiore
5.5 Monta i sensori
Installa MPU-6050 e BMP280 con viti M3x20mm, dadi autobloccanti e dadi normali
5.6 Unisci i telai superiore e inferiore
Fai passare i cavi di alimentazione degli ESC nei fori del PCB superiore, saldali, collega con i distanziali
5.7 Prova tutti i sistemi
Verifica i collegamenti con il multimetro. Alimenta via USB. Prova sensori, ricevitore, motori.
6. Controllore di volo: modalità Rate
Implementa il regolatore PID di velocità angolare per rollio, beccheggio e imbardata. Primo volo in modalità Rate.
6.1 Implementa il regolatore PID
Unisci tutto il codice: giroscopio, ricevitore, motori, batteria. Aggiungi il PID per le velocità di rollio/beccheggio/imbardata.
6.2 Aggiungi le funzioni di sicurezza
Protezione dal windup dell'integrale (limite di 400us), limiti dei motori (1180-2000us), interruzione del gas sotto 1050us
6.3 Configura il failsafe del trasmettitore
Imposta i valori di failsafe del trasmettitore
6.4 Primo volo in modalità rate
Volo di prova. Valori PID: P_roll/pitch=0.6, I=3.5, D=0.03, P_yaw=2, I_yaw=12
7. Controllore di volo: modalità Stabilize
Aggiungi un filtro di Kalman per la stima degli angoli. Implementa un PID in cascata per il volo autolivellante.
7.1 Misura gli angoli
Integra le velocità del giroscopio per ottenere gli angoli. Usa la trigonometria sull'accelerometro per rollio/beccheggio. Confronta i due metodi.
7.2 Implementa un filtro di Kalman 1D
Combina la previsione dall'integrazione del giroscopio con la misura dell'accelerometro per ottenere angoli stabili
7.3 Aggiungi l'anello PID in modalità angolo
Implementa un PID in cascata: l'anello esterno sull'angolo alimenta l'anello interno sulla velocità. Volo autolivellante.
8. Controllore di volo: modalità Velocity
Aggiungi la misura dell'altitudine con il barometro, un filtro di Kalman 2D, il controllo della velocità verticale.
8.1 Aggiungi la misura dell'altitudine
Collega il barometro BMP280. Converti le letture di pressione in altitudine.
8.2 Implementa un filtro di Kalman 2D
Combina l'altitudine del BMP280 con l'accelerazione verticale dell'accelerometro in un vettore di stato 2D
8.3 Aggiungi il controllo della velocità verticale
Mappa il gas sulla velocità verticale desiderata. Implementa il mantenimento della quota con smorzamento della velocità.