Archivi tag: modello matematico

Alfa3test. Aggiornamento sviluppo

Sono ancora operativo…anche se due settimane fa ho avuto qualche problema con la batteria.Una volta scaricata non ne ha piu’ voluto sapere di farsi ricaricare…

Questo e’ successo mentre stavo raccoglendo un po di dati.In particolare stavo registrando in comportamento della mia struttura di test al variare dei  parametri P,I,D. Sono riuscito a raccogleire solo pochi dati, ma quello che posso mostrare ora e’ un piccolo successo: il mio modello matematico e’ abbastanza fedele al reale.Qui trovi il link

In queste  immagini si puo’ vedere l’andamento teorico (blu) previsto dal modello matematico e il comportametne reale del quadricottero (rosso).

Questo e’ il caso con P=0.3  I=0 D=0.05

comparison teorical _real1

Questo e’ il caso con P=0.5 I=0.7  D=1,75

comparison teorical _real2

Questo e’  molto importante perche in questo modo posso testare sul modello matematico il comportametno del quadricottero, al variare dei parametri  P,I e D  in attesa di sitemare la batteria!

SW Dev: modello matematico – correzione e migliorie

ciao,
nel post precedente ho incluso un xls file col modello matematico della dinamica di un quadricottero.
mi sono accorto di un errore banale. calcolavo l’accelerazione usando la velocita’ angolare espressa in rpm % e non in  rpm. Questo portava ad un valore di R.current completamente errato.

In questa nuova versione ho anche aggiunto il calcolo della velocità angolare di equilibrio wh (si veda elica per la spiegazione del calcolo)

control loop rev 2

Di nuovo,se qualcuno interessato, mi invia i dati del proprio quadricottero (lunghezza motore-centro quad ,  massa braccio, massa motore, massa totale ,tipo di elica ,e parametri PID) mi piacerebbe buttarli dentro e validare il modello.

SW Dev: Modello matematico del loop di controllo

Prima di avventurami nello scrivere il codice in python del controllo ho provato a mettere giu il modello matematico che riproduca il comportamento dinamico teorico del quadricottero.Lo potete trovare qui in control_loop.xls.[Rimosso. Vedi qui]

 

Per favore,se qualcuno interessato mi invia i dati del proprio quadricottero (lunghezza motore-centro quad ,  massa braccio, massa motore, massa totale e velocita di hover,e parametri PID) mi piacerebbe buttarli dentro e validare il modello.

Ipotesi iniziali:

  • Quadricottero configurazione +
  • Caso di rotazione Roll

Dati:

  • R.target e’ il valore desiderato
  • R.acc  e’ l’accelerazione angolare ( che calcolo in funzione delle velocita angolari w del motore, al passo precedente

L’equilibrio dimanico e’ dato da:

(F1-F3)b=I R.acc       Kprop(w1^2-w3^2)b= I R.acc

con Kprop=(Mtot*g)/wh^2  I=(Mbar*b^2)12+2*Mmotor*b^2

R.acc=Kprop*(w1^2-w3^2)b/I

  • R.vel  e’ la velocita’ ricavata come integrale di R.acc
  • R.curr e la rotazione teorica del quadricottero ricavata come integrale di R.vel.Tale valore corrisponde il linea teorica al valore che dovrei leggere col giroscopio.

PID

Pertanto questo modello mi permette di  giocare con i parametri P,I,D , vedere come potrebbe oscillare e di ottimizzarli di conseguenza.