Professional Documents
Culture Documents
Modellenmesi ve Kontrolü
K. T. Öner1 , E. Çetinsoy2 , E. Sırımoğlu3 , T. Ayken4 , M. Ünel5 , M. F. Akşit6 , İ. Kandemir7 , K. Gülez8
1,2,3,4,5,6
Mühendislik ve Doğa Bilimleri Fakültesi
Sabancı Üniversitesi, Orhanlı-Tuzla, 34956, İstanbul
{kaanoner ,cetinsoy ,efesirimoglu ,tayken}@su.sabanciuniv.edu
{munel ,aksit}@sabanciuniv.edu
7
Mühendislik Fakültesi
Gebze Yüksek Teknoloji Enstitüsü, Çayırova-Gebze, 41400, Kocaeli
{kandemir}@gyte.edu.tr
8
Elektrik-Elektronik Fakültesi
Yıldız Teknik Üniversitesi, Barbaros Bulvarı-Yıldız, 34349, İstanbul
{gulez}@yildiz.edu.tr
2. Dinamik Model
Hava aracı, aracın arka ve ön tarafına monte edilmiş dikey Bu denklemlerde φ, θ, ψ sırasıyla yuvarlanma, yunuslama
ve yatay konum arasında geçiş yapabilen dört adet kanatla ve sapma açılarını temsil etmektedir. Doğrusal ve açısal
donatılmıştır. Şek. 1 ’de hava aracı dikey ve yatay uçuş mod- hızların araç üzerindeki koordinat sistemi ile dünya koordinat
larında görünmektedir. sistemi arasındaki ilişkisini veren denklemler ise (1) ve (2)’de
verilmiştir:
vx
Vb = vy = R(φ, θ, ψ) · Vw (1)
vz
Bu denklemde dönme matrisi
R(φ, θ, ψ) = Rz (ψ)Ry (θ)Rx (φ)
olarak tanımlanmıştır.
Şekil 1: Hava Aracı Dikey ve Yatay Uçuş Modlarında
p
Ωb = q = E(φ, θ) · Ωw (2)
Bu kanat yapısıyla, hava aracının gövdesi kanatlar dikey r
konumdayken dört-rotorlu bir helikopter yapısına, kanat- Bu denklemdeki hızları dönüştüren matris şu şekilde verilmek-
lar yatay konumda iken ise standart bir uçak yapısına tedir:
bürünmektedir. Öndeki iki kanat birbirinden bağımsız olarak 1 0 −sθ
döndürülerek eleron görevini yapmakta iken arkadaki kanat- E(φ, θ) = 0 cφ sφ cθ
lar birlikte hareket ederek elevator görevi üstlenmektedir. Bu 0 −sφ cφ cθ
şekilde yatay uçuş modunda uçan bir uçağın kontrol yüzeyleri sβ ve cβ kısaltmaları sin(β) ve cos(β) yerine kullanılmaktadır.
en az sayıda eyleyici ile taklit edilmektedir. Aracın 6 serbestlik dereceli dinamik denklemleri araç
Şek. 2’de araç üzerinde tanımlanmış B : (Ob , xb , yb , zb ) üzerindeki koordinat sistemi B’de şu şekilde yazılabilir:
koordinat sistemi ve dünya üzerinde tanımlanmış W :
(Ow , xw , yw , zw ) ataletsel koordinat sistemi gösterilmiştir. Bu Ft = mV̇b + Ωb × (m · Vb ) (3)
koordinat sistemleri kullanılarak hava aracının yönelim ve Mt = Ib Ω̇b + Ωb × (Ib · Ωb ) (4)
pozisyonu dinamik ve kinematik denklemlerle elde edilmiştir.
Bu denklemlerde m aracın kütlesini Ib ise aracın B koordinat
Aracın ağırlık merkezinin pozisyonu ve doğrusal hızı şu şekilde
sisteminde ifade edilmiş atalet matrisini temsil etmektedir.
tanımlanmıştır:
Aracın ağırlık merkezine etkiyen toplam kuvvet (Ft ) rotor-
ların ürettiği itki kuvveti (Fth ), yerçekimi kuvveti (Fg ), kanat-
X Ẋ
Pw = Y , Vw = P˙w = Ẏ ların ürettiği kaldırma ve sürükleme kuvvetleri (Fw ) ve bozucu
Z Ż aerodinamik kuvvetler (Fd ) toplamından oluşmaktadır:
Ft = Fg + Fw + Fth + Fd (5)
Aracın yönelimi ve açısal hızları ise şu şekilde ifade edilmekte-
dir: Burada,
φ φ̇ −sθ
αw = θ , Ωw = α˙w = θ̇ Fg = sφ cθ · mg
ψ ψ̇ cφ cθ
Tablo 1: Model Parametreleri
(FD (θ1 , vx , vz ) + FD (θ2 , vx , vz ) + 2FD (θ3 , vx , vz ))
Fw = 0 Sembol Tanım Boyut/Birim
(FL (θ1 , vx , vz ) + FL (θ2 , vx , vz ) + 2FL (θ3 , vx , vz )) m kütle 4 kg
ls rotor y ekseni uzaklığı 0.25 m
ve
kω1 2 ll rotor x ekseni uzaklığı 0.25 m
cθ1 + cθ2 + cθ3 + cθ3 2 λ1,4 tork/kuvvet oranı 0.01 N m/N
Fth = 0 kω2 2 λ2,3 tork/kuvvet oranı -0.01 N m/N
kω3
−sθ1 − sθ2 − sθ3 − sθ3
kω4 2
olarak verilmektedir. Pervane itkileri F(1,2,3,4) ise açısal hızın
karesiyle doğru orantılı olacak şekilde modellenmiştir:
3. Denetleyici Tasarımı
Fi = kωi2 Çeşitli denetleyiciler tasarlamak için II. bölümde elde edilen
denklemler durum uzayı formuna sokulmuştur. Durum uzayı
Arka kanatlar birlikte döndükleri için hücum açıları bir- vektörü χ aracın pozisyonu (Pw ), yönelimi (αw ), doğrusal
birine eşit olmaktadır (θ3 = θ4 ). Kaldırma kuvveti hızları (Vb ) ve açısal hızlarından (Ωb ) oluşmaktadır:
FL (θi , vx , vz ) ve sürükleme kuvveti FD (θi , vx , vz ) sadece
doğrusal hızların birer fonksiyonu olmayıp aynı zamanda (vx Pw
ve vz ) her bir kanadın hücum açısı θi ’ye bağlıdır. Bu denklem- Vb
χ=
Ωb (7)
lerin açık halleri bildirinin sonundaki Ekte verilmiştir.
Aracın ağırlık merkezine etkiyen tork Mt rotorların αw
yarattığı tork (Mth ) sürükleme ve kaldırma kuvvetlerinin
yarattığı tork (Mw ), pervanelerin jiroskopik etkisinden oluşan (1)-(6) numaralı denklemler ışığında,
tork (Mgyro ) ve bozucu etken olan aerodinamik tork (Md )’nin
toplamından oluşmaktadır. Ṗw R−1 (αw ) · Vb
V̇b 1/m · [Ft − Ωb × (m · Vb )]
χ̇ =
Ω̇b = I −1 · [Mt − Ωb × (Ib · Ωb )] (8)
Mt = Mgyro + Mw + Mth + Md (6) b
α˙w E −1 (αw ) · Ωb
Burada,
4 c θi elde edilmektedir. Bu doğrusal olmayan denklemler şu formda
X
Mgyro = J[ηi Ωb × 0 ωi ] ifade edilebilir:
i=1 −sθi χ̇ = f (χ, u) (9)
η(1,2,3,4) = 1, −1, −1, 1 Dört rotorlu hava aracı dikey uçuş modunda 12 boyutlu bir
durum uzayı vektörüne sahipken 4 boyutlu bir girdi vektörüyle
denetlenmektedir.
(FL (θ1 , vx , vz ) − FL (θ2 , vx , vz ))
Mw = (FL (θ1 , vx , vz ) + FL (θ2 , vx , vz ) − 2FL (θ3 , vx , vz )) 3.1. Doğrusallaştırılmış Model ve LQR Tabanlı Denetleyici
(−FD (θ1 , vx , vz ) + FD (θ2 , vx , vz )) Tasarımı
10
x coordinate
0 reference
Ωp = ω1 − ω2 − ω3 + ω4
−10
0 5 10 15 20 25
Bu denklemlerin PID denetim için doğrusallaştırılmaları time [s]
y coordinate [m]
20
Ixx z coordinate
0 reference
u3
θ̈ = (20)
Iyy −20
0 5 10 15 20 25
u4 time [s]
ψ̈ = (21)
Izz
Bu dinamik denklemler için, hata fonksiyonunun e(t) =
Şekil 4: LQR Denetleyici ile Aracın Pozisyon Denetimi
Xref − X(t) şeklinde tanımlandığı PID denetim kuralı ise şu
şekilde elde edilmiştir:
Z t Pozisyon ve açı referanslarının denge konumuna oldukça
dX(t)
u(t) = Kp e(t) + Ki e(τ )dτ − Kd (22) küçük hatayla ulaştıkları gözlemlenmiştir. Şek. 6’da her
0 d(t)
bir rotorun ürettiği itki kuvvetleri gözükmektedir. Üretilen
Burada Kp , Ki ve Kd denetimci parametreleri olup X(t) bu kuvvetlerin rotorların fiziksel limitleri olan (' 16 N)’u
değişkeni φ, θ, ψ ve Z durum değişkenlerini temsil etmekte- aşmaması ve nominal itkinin ±%20 sınırı dışına çıkmaması
dir. önemlidir.
roll angle [deg]
20
roll angle [deg]
20 φ coordinate
φ coordinate reference
0
0 reference
−20
−20 0 10 20 30 40 50 60
0 5 10 15 20 25 time [s]
20 reference
0
θ coordinate
0 reference
−20
0 10 20 30 40 50 60
time [s]
−20
100 0
ψ coordinate
−50
0 reference 0 10 20 30 40 50 60
time [s]
−100
0 5 10 15 20 25
time [s]
z coordinate [m]
0
z coordinate
15 −5
F1 [N]
reference
10 −10
0 5 10 15 20 25 0 10 20 30 40 50 60
time [s] time [s]
15
F2 [N]
15
F3 [N]
10
0 5 10 15 20 25
14
time [s]
F1 [N]
12
10
0 10 20 30 40 50 60
time [s]
14
Şekil 6: LQR Denetimi Altında Eyleyici Eforu
F2 [N]
12
10
0 10 20 30 40 50 60
time [s]
14
F3 [N]
12
10
0 10 20 30 40 50 60
Tablo 2: PID parametreleri time [s]
Kp Ki Kd
Yuvarlanma (φ) 1 0.001 0.5 Şekil 9: PID Denetimi Altında Eyleyici Eforu
Yunuslama (θ) 1 0.001 0.5
Sapma (ψ) 0.5 0.001 0.9
İrtifa (Z) 2 0.1 2.5
5. Deneysel Sonuçlar
T
konumu ve αw = (0, 0, 0) yöneliminde olan araç için, Şek. 7 Tasarlanan PID denetimciler SUAVİ’nin üzerinde bulunan
ve 8 aracın yönelim ve irtifa değişkenlerinin kullanıcı girdileri mikrodenetleyiciye uygulanmış olup aracın yönelim kontrolüne
altındaki değişimini göstermektedir. dair uçuş testleri yapılmıştır. Sapma açısının denetimi için
Verilen irtifa ve yönelim komutlarının küçük kararlı hal gereken ölçümün henüz tam sağlıklı biçimde elde edilememesi
sebebiyle yönelim denetimi sapma ekseni için açısal hız
değişkeni üzerinden yapılmıştır. Üç metreye üç metre boyut-
larındaki bir alanda yapılan uçuş deneyinlerine ait bir grafik
Şek. 10’da verilmiştir.
roll angle φ [deg]
−5
0 10 20 30 40 50 60 70
time [s]
pitch angle θ [deg]
−5
0 10 20 30 40 50 60 70
time [s]
yaw rate [deg/s]
20
−20
0 10 20 30 40 50 60 70
time [s]
p
7. Teşekkür vα = vx2 + vz2 (23)