RX->Arduino->Accelerometer+gyro
 

Salve ragazzi.
Qualcuno ha esperienza su come usare arduino non per un drone ma per stabilizzare un aereo?
Io ci sto mettendo la testa.
Per adesso posto il link per leggere i comandi mandati dal radiocomando tramite questo circuito
http://trax3d.altervista.org/Temp/READ_6PPM.jpg
Il risultato preso tramite la serial port:
http://trax3d.altervista.org/Temp/Lettura_6PPM.jpg
Cito la fonte: Reading RC Receiver PPM Signal Using Arduino: 3 Steps

Prossimo passaggio collegare Accelerometer+gyro in questo caso l' MPU5060
A presto

Una cosa non mi convince molto: i valori letti mi sembrano di "fantasia" come temporizzazioni, bisognerebbe verificarli con un oscilloscopio o un analizzatore di stati logico.

Con il sistema dell'articolo poi mi pare che alla fine legga un pacchetto su due quindi si aumenta la latenza.

Per imparare a programmare il progetto è valido, per uso pratico ci sono in commercio buoni stabilizzatori cinesi a 10€, esiste anche progetto open source serio per modificarne il firmware, potresti prender spunto da li.

:yeah:

Guarda qui: https://github.com/noobee/FlightStab

:yeah:

Non saprei per i pacchetti (non me ne intendo moltissimo) ma se ad ogni interrupt vengono memorizzari i cambi di stato, sapendo che l'intervallo di un pacchetto con successivo è di 11500 microseconds , come fai a dire che ne viene saltato uno?
Comunque visualizzando i movimenti dal serial monitor in diretta non vedevo alcun ritardo rispetto ai comandi dati al trasmettitore.

Beh il ritardo non é di secondi, ma decimi o o meno, difficile che a vista lo noti.
Comunque mi sa che se prendi qualche vecchio progetto multiwii o simile risolvi, li é spiegato bene come usare un arduino e i chip giro/acc.
Poi se é per giocare sperimentare ok, ma se vuoi qualcosa di pronto, ormai ci sono decine di stabilizzatori, anche per tutti e e tre gli assi, per non parlare poi quota, GPS ecc..
Ma se a te interessa sol stabilizzatore, cerca un po' multiwii...


Inviato dal mio iPad utilizzando Tapatalk

Aggoirnamento:
ho scartato l'opzione di lettura dei 6 canali PPM dal pin 1 , ho notato che ci sono dei blackout anche di alcuni secondi nella lettura ... e non so perchè.
Sono passato quindi alla lettura diretta dei canali AIL e ELE sui pin 5 e 6
il canale GEAR lo userò per poter attivare e disattivare il programma
i pin 9 e 10 saranno in uscita sui servi AIL e ELE
La logica è questa:
AIL tutto a destra inclinazione massima dell'aereo +60° e -60° per tutto sinistra
stesso per ELE +60 / -60
Questo vuol dire che per esempio mettendo tutto a destra l'alettone il servo risponderà fino all'inclinazione di 60° a destra dopo di che si metterà in posizione centrale cercando di tenere l'aereo stabile.
In teoria usando il timone l'aereo dovrebbe fare una virata perfettamente in piano (o almeno questa è la teoria)
Ora mi manca di trasferire tutto su arduino nano e cablare sul mio edge-flat per poter fare il primo test.
Vi farò sapere
Saluti

La vedo come soluzione un po' pericolosa e semplicistica.
E se l'aereo e' in volo rovescio ad esempio cosa fai?
Per misurare l'inclinazione cosa usi?
L'accelerometro non va mica bene, in una virata corretta anche a 60 gradi segnerebbe 0 gradi, mi sa.
Ti serve un sensore piezoelettrico con logica hold applicata, direi che le cose si complicano.

Un accelerometro a 3 assi in genere è in grado di sapere se sta "a balle all'aria", poi per filtrare accelerazioni sugli assi e ricavare su un corpo in movimento la reale inclinazione ci vuole tanta matematica e magari anche un giroscopio, a 3 assi pure lui.... :fiu:

:yeah:

Un accelerometro a 3 assi e' in grado di farlo in volo rettilineo, ma se sei in virata prova a vedere come si piazza il pendolo all'interno della cabina dell'aereo.
In questo caso secondo me senza un software con logica di tipo Hold da inizializzare alla partenza non riuscirai ad avere indicazioni attendibili.
Con logica Hold direi che basta un giroscopio ad un asse, per valutare l'angolo di rollio. Gli elicotteri rc di vecchio tipo (quelli con flybar e giroscopi tipo Gy401) funzionavano cosi', sull'asse di imbardata pero'.

Non ho chiaro cosa intendi per "logica Hold" se ti riferisci alla calibrazione a terra del velivolo come si fa con i multifrulli ruotandoli sui tre assi) e non sono nemmeno molto esperto di piattaforme inerziali però direi che interpolando i 3 assi di un giroscopio sia possibile, in assenza di variazioni di velocità significative da cui accelerazioni modeste, stabilire nello spazio l'orientamento di un piano.

Se poniamo riferiti all'accelerometro: asse X = rollio, asse Y = beccheggio , asse Z verticale anche in caso di virata a coltello avremo che l' asse Z indicherà l'accelerazione centrifuga (con segno opposto in caso di virata rovescia) e l'asse X l'accelerazione di gravità, mentre l'asse Y il relativo angolo di beccheggio.

Chiaramente è necessario filtrare i segnali dell'accelerometro applicando opportuni algoritmi, se già non li conosci dai un occhiata ai quaternioni.

IMHO.

:yeah:

Per la mia tesi ho dovuto anche usare un raspberry con accelerometri, giroscopi e magnetometri montati a bordo per poi replicare i movimenti su pc con Matlab....per quanto su internet si riesca a trovare qualcosa, la matematica che ci sta dietro è alquanto complessa. Per il mio progetto ho trovato questo articolo che può darti qualche spunto, in cui vengonon mostrati i calcoli e le formule per arrivare a stimare gli angoli di pitch, roll e azimuth con solo accelerometro e magneometro (nel modello con gli apparati radio a bordo non è proprio idoneo quest'ultimo).
Utilizzando le formule opportune sono riuscito ad ottenere buoni risultati (anche se non era questo il focus della tesi) ma comunque utili per quello che mi serviva: unica condizione è che la scheda con a bordo i sensori deve muoversi molto lentamente perchè non ho compensato con i dati del giroscopio (mancanza di tempo)

Come dice El Nonino i dati vanno gestiti in modo adeguato con filtri (tipo Kalman) e quaternioni e secondo me non è semplice...ma comunque fattibile!!

La logica di tipo Hold e' quella che facendo di continuo l'integrale dei dati ricevuti da un giroscopio (quindi un accelerometro non lineare, ma angolare) calcola continuamente l'angolo di deviazione su quell'asse rispetto all'angolo di reset o di ultimo comando applicato.
Questo funziona solo su sensori di tipo giroscopico e non su accelerometri lineari.
I primi giroscopi per elicotteri rc si limitavano infatti a correggere l'imbardata istantanea e richiedevano un preciso trimmaggio. Tutti quelli meccanici ad esempio erano di questo tipo.
Poi sono arrivati quelli con logica Hold, in cui si poteva scegliere di 'tenere la coda fissa all'ultimo comando inviato'. Con questi non serve il trimmaggio, in quanto applicano a tempo indefinito la correzione necessaria per riportare all'ultimo angolo specificato dal comando ricevuto.
Un giroscopio di questo tipo lo si vede subito, in quanto se muoviamo manualmente la coda su un elicottero fermo posato a terra, il servo manda il comando lentamente ma inesorabilmente a fondo corsa, invece di dare un semplice impulso di correzione.

Sono arrivato a dire questo perche' l'asse di rollio di un aereo (caso preso in esame all'origine di questa discussione) e' analogo all'asse di imbardata di un elicottero, e per quel caso esiste una marea di documentazione su come affrontarlo.
Gli accelerometri lineari li vedo estremamenti inadatti allo scopo, anche perche', come gia' detto, su un aereo in virata corretta anche a 45 gradi indicherebbero inclinazione zero rispetto a terra (vedi pendolino in cabina).
Per calcolare l'angolo dovrebbero aggiungere l'incremento di componente verticale (riferirita al sistema di riferimento dell'aereo), ma poi si andrebbe ad incasinare con una eventuale accelerazione reale verticale, e quindi vi sono comunque piu' gradi di liberta' che valori ricevuti. Qualcosa di simile all'esperimento ideale base di Einstein sulle misurazioni fisiche possibili all'interno di un ascensore posto in un campo gravitazionale...
Naturalmente tutto quanto detto rispecchia il mio pensiero e quello che ho capito studiando questa problematica negli ultimi 15 anni.
I quaternioni li conosco piuttosto bene, sono il metodo di calcolo base che si usa nelle applicazioni di grafica 3D, ma non li vedo molto utili per risolvere i problemi descritti sopra.

Capito cosa intendi per logica Hold, la conosco benino visto che di elicotteri ne ho un discreto numero da molti anni e ci ho volato/volo spesso.....

Dissento invece sul resto, un accelerometro a 3 assi è sempre in grado di indicare l'inclinazione sull'asse di rollio.

In volo rettilineo dritto a quota costante, con ali livellate l'asse z dell' accelerometro misurerà l'accelerazione di gravità con segno positivo, gli assi x ed y avranno uscita pari a 0.

Nelle stesse condizioni ma in volo rovescio l'asse z misurerà l'accelerazione di gravità ma con segno negativo, gli altri assi daranno 0.

in caso di virata a velocità costante con il resto nelle stesse condizioni precedenti (quindi ignorando il valore momentaneo di accelerazione) l'asse z indicherà l'accelerazione centrifuga mentre quello x restituirà un valore positivo o negativo a seconda del verso della virata.

Lo stesso concetto si applica per l'asse y, quindi interpolando i valori dei tre assi si conoscerà l'esatta inclinazione del piano del velivolo nello spazio.

Campionando i segnali velocemente rispetto alla velocità del mezzo e calcolando la derivata prima e seconda sui tre assi è possibile ottenere la posizione anche in presenza di accelerazioni, se poi si fondono i dati dell'accelerometro con quelli di un giroscopio a tre assi.....

Per inciso nel mio sistema di antirotazione per le barelle (brevettato) uso un accelerometro a 3 assi ed un giroscopio ad un asse e posso garantirti che funziona sia durante le operazioni in hovering che in volo traslato.

Utilizzo da nove anni un semplice accelerometro a 3 assi anche per misurare l'inclinazione verticale dei pannelli FV del mio sistema di Suntracking in baita, onde poterli posizionare ad angoli ben precisi in caso di vento, neve o particolari condizioni di insolazione.

:yeah:

Addendum...
 

Chiaramente per mantenere una velocità di rotazione nulla intorno ad un asse basta un giroscopio e questo vale sia per la rotazione della coda di un elicottero che per un qualsiasi asse di un velivolo, è la filosofia utilizzata dai vari stabilizzatori Safe o 3GX.

Il miglior risultato lo si ottiene chiaramente, come già detto, con gyro + acc a 3 assi.

:yeah:

Ok.

Se hai 3 accelerometri lineari che ti danno questi valori:
x = 0.0 g
y = 0.0 g
z = 1.2 g

come stabilisci se il modello e' in virata o sta accelerando verso l'alto?

Io non saprei dirlo.

Sono davvero curioso di leggere la soluzione, ho giocato/lavorato un poco sulla stabilizzazione e per la mia, modesta, esperienza il gyro è essenziale ma sono sempre pronto ad imparare qualcosa di nuovo !

Chiaramente i 3 valori sono quelli iniziali con il modello in piano e fermo, e da questi si parte a campionarli ad intervallo di tempo costante.

Allora se accelera verso l'alto con ali in piano ci sarà solo una variazione iniziale dell'asse z che andrà ad azzerarsi quando il rateo di salita (velocità asse z) diverrà costante ma avendo integrato i valori letti potremo ricavare la velocità ed in caso di variazioni della lettura sapremo anche se sta in hovering o se casca.....

In virata piatta avremo che l'asse x avrà una variazione iniziale per poi stabilizzarsi su un valore proporzionale all'accelerazione centrifuga (con segno diverso se cw o ccw), inoltre anche l'asse y avrà variazioni iniziali proporzionali al verso della virata mentre z resterà costante; nella classica virata avremo che varieranno tutti e tre gli assi e queste variazioni, diverse, le troveremo anche in virata con spirale in salita/discesa.

La similitudine con un pendolo ad infiniti gradi di libertà forse non si adatta bene a rappresentare un accelerometro a 3 assi, forse è più adatto immaginarlo come 3 pendoli vincolati con un solo grado di libertà.

E' chiaro che per interpretare i dati e quindi ricavare l'assetto del velivolo e la direzione e velocità del suo moto è necessaria tanta matematica (meglio se in floating point....) e potrebbero esserci casi particolari in cui il risultato non è univoco.

Un grosso limite degli accelerometri è quello dato dalla non linearità degli stessi (ha andamento sinusoidale e per avere valori precisi già solo di angolo statico richiede l'uso di tabelle di linearizzazione per ogni singolo asse ed interpolazione).

Su Wiki si trovano sintetizzate formule interessanti: https://it.wikipedia.org/wiki/Equazione_del_moto che sono utilizzate/implementate anche in sensori evoluti come questo (anche se definito obsoleto): ADIS16305 Datasheet and Product Info | Analog Devices


:yeah:

Quindi concordi che alla fine è più pratico usare i gyro :wink:

Anche con i Gyro devi usare tanta matematica, per sapere l'angolo d'inclinazione su un asse devi partire da una velocità angolare e dal tempo, con gli accelerometri usa un accelerazione ed il tempo, in un caso integri nell'altro differenzi.

L'accelerometro in più può fornire anche una velocità stimata sull'asse del moto mentre il gyro no perchè lavora sulla velocità angolare quindi se vuoi tenere ferma la coda di un eli ok per gyro se vuoi tenere in piano e fermo un eli od un multirotore meglio l'accelerometro.

Nel mio sistema antirotazione delle barelle uso quella piattaforma inerziale citata perchè con due assi dell'accelerometro compenso l'inclinazione della barella sull'asse di rollio (varia a seconda del peso del soccorritore e se dx o sx) indispensabile affinchè l'ala in assenza di rotazione resti verticale, mentre il gyro mi permette di contrastare e azzerare la rotazione indotta dal flusso circolare rotorico dell'elicottero.

:yeah:

La soluzione migliore e più semplice, per me e per la mia esperienza ovviamente, sono 3 gyro + 3 accelerometri... ed eventualmente un magnetometro a 3 assi, per correggere gli errori nel lungo periodo sulla rotazione dell'asse verticale, ma sicuramente ci sono scelte migliori .... forse :wink:

Beh dipende, come ho scritto la soluzione ottimale è chiaramente usare acc e gyro a 3 assi, forse è la più semplice perchè per sensori standard si trova tanta pappa fatta. :wink:

:yeah:

O forse semplicemente perchè è la più logica e meno contorta... e non parlo di applicazioni modellistiche :wink:

c'é un autopilota sviluppato da un f3kapparo che va molto bene.
https://youtu.be/fzh9w1H5ve0

Inviato dal mio ALE-L21 utilizzando Tapatalk

Ti riferisci ad applicazioni "dronistiche low level" o di velivoli 1:1 ?

Sicuramente più dati si acquisiscono maggiore è la precisione che si ottiene, però aumenta anche la complessità del fw e relativa matematica richiesta, se devo solo tenere le ali di un modello livellate in atterraggio meglio un accelerometro.... :fiu: :D :D

Poi se per te i quaternioni non sono "contorti" ed il filtraggio ed analisi in real time dei dati di nove sensori sono bazzecole mi inchino al tuo sapere. :fiu:

:yeah:

No, si tratta di un sistema di puntamento di precisione, non militare ovviamente, per mezzi in movimento ... anche in mare incazzato.

In ogni caso non voglio polemizzare con la tua smisurata esperienza... e visto che si tratta di lavoro chiudo qui !

Tranquillo, la mia esperienza non è smisurata..... imparo sempre qualcosa di nuovo ogni giorno, comunque fra stabilizzare un mezzo e mantenere puntato un obiettivo da un mezzo in movimento ci passano alcune differenze.

Una cosa è tenere in virata costante un C130 Gunship un'altra far si che i suoi cannoncini mirino sempre la stessa zona. :wink:

:yeah:

Secondo voi le telecamere montate sul codone delle MotoGp hanno un giroscopio con logica hold o accelerometri?
Credo che la risposta dia un'idea di quale sia la via piu' semplice da seguire.

Non direi, la telecamera è fissa sul codone della moto e deve sostanzialmente compensare la rotazione su un solo asse, rollio, le problematiche di stabilizzazione di un velivolo libero di muoversi e ruotare su 3 assi sono assi diverse.

Negli airbag si usano gyro od accelerometri ?

@sub53: se devi tenere puntato un obiettivo quando sali e scendi da onde alte 10m (senza subire rotazioni su alcun asse) come fai con il giroscopio ?

Come fai a stabilire la velocità di salita o traslazione in piano su un asse con un gyro visto che risponde solo alla velocità angolare ?


:yeah:

Con i sensori dedicati .... ovviamente non leggi quanto da me postato precedentemente:

sono 3 gyro + 3 accelerometri... ed eventualmente un magnetometro a 3 assi

Non capisco cosa vuoi dimostrare, ogni sensore ha la sua funzione, poi puoi inventarti altre soluzioni per diversi motivi... e ripeto per l'ultima volta, la mia modestissima esperienza mi ha dimostrato che le soluzioni più semplici in genere funzionano, e spesso non hanno neanche bisogno di processori sofisticati. Vai a studiarti la stabilizzazione della V2 ( A4 ) ad esempio.

Tutta la mia disquisizione era iniziata obiettando sulle scelte fatte per la semplice stabilizzazione sull'asse di rollio...