Professional Documents
Culture Documents
Zaferb@kou.edu.tr
Coysu@kou.edu.tr
Özetçe
θ = 180 °
Bu çalışmada, kontrol teorisinin klasik problemlerinden biri denge noktası
dengenin yitirilmes i
olan gerçek zamanlı doğrusal olmayan bir ters sarkaç Sarkaç encoder üzerinde
sisteminin kontrolü gerçekleştirilmiştir. Yatay eksen üzerinde serbestçe hareket etmektedir
56 cm mesafe içerisinde hareket edebilen arabaya bağlı Arabalı Sarkaç Sistemi
θ = 0°
bulunan sarkacın, aşağı yöndeki başlangıç durumundan denge nok tası
(θ=00) dikey duruma (θ=1800) getirilmesi ve bu pozisyonda
durağan tutulması iki farklı yöntemle gerçeklenmiştir.
Sarkacın ters dikey pozisyona getirilmesi için enerji tabanlı
bir kontrol yöntemi ile ve bu pozisyonda durağan
kalabilmesini sağlamak amacıyla PID ve tam durum geri- (a) (b) (c)
1 1
KEm = mVc * Vc + Iω 2 (1)
2 2
Şekil 3: Arabalı ters sarkaç sistemi Burada ω sarkacın açısal hızı, Vc ise arabanın hızıdır ve rc
konum vektörünün türevi alınarak bulunur:
-176 50
-178 0
K = [k1 k 2 .....k n ] (24)
-180 -50
u
-182 -100
+ x& x y
B ∑ ∫ C
-184 -150
0 0.5 1 1.5 2 0 0.5 1 1.5 2
-174
Sarkaç Açısı - Deneysel
40
Sarkacın Açısal Hızı - Deneysel +
20
Vektörel
-176
A
0
-178
-20
-180
-40 Skaler
-60
-182
-80
-184
0 0.5 1 1.5 2
-100
0 0.5 1 1.5 2 Şekil 12: Sistemin durum uzayı blok diyagramı
Zaman (sn) Zaman (sn)
r +
∑
u +
∑
x& x y
Şekil 10: PID kontrol yöntemine ait benzetim ve B ∫ C
deneysel sonuçlar + +
100 0.1
Skaler
0.05
0
-K
0
-0.05
-100
-0.1
-0.15
-200
0 5 10 15 20 25 30 0 5 10 15 20 25 30
Şekil 13: Durum geri beslemeli sistem
Arabanın Konumu Arabanın Hızı
0.2 1
Teorik olarak, birçok sistem için uygun kazanç matrisi ile
0.1 0.5 sistem kutup noktaları istenilen herhangi bir yere
0 0
yerleştirilebilir. Bu yöntemi kullanarak hızlı ve kararlı sistem
cevabı elde edilebilir. Ancak, gerçek performans fiziksel
-0.1 -0.5
donanımla sınırlıdır. En iyi sonuçlar, cevap hızı ve kontrol
-0.2
0 5 10 15 20 25 30
-1
0 5 10 15 20 25 30
eforu arasında optimizasyon yapılarak ulaşılabilir. Bu nümerik
Zaman (sn) Zaman (sn)
olarak Denklem 25 ile ifade edilen doğrusal-karesel-regülatör
(linear quadratic regulator - LQR) yöntemi kullanılarak
Şekil 11: Sarkacın dik duruma getirilmesi ve PID
yapılabilir. MATLAB yazılımının ‘lqr’ fonksiyonu, durum
kontrol yöntemlerinde açının, kontrol sinyalinin, araba
hataları ile kontrol eforu değerlerinin ağırlıklandırılmasını
konumunun ve hızının zamanla değişimi
sağlayarak optimum kazanç matrisini hesaplar. Denklem
26’da belirlenen Q matrisi, R katsayısı ve Denklem 27’de
4.3 Tam Durum Geri Besleme Yöntemi ile Sarkacın bulunan K kazanç matrisi görülmektedir. Şekil 14’de sistem
Dengelenmesi kutuplarının kontrol sonucundaki yerlerinin değişimi
görülmektedir.
x& = Ax + Bu ∞
(22) J = ∫ x(t ) T Qx(t ) + u (t ) T Ru (t )dt (25)
y = Cx
0
1.2
Orijinal 0
20
1
Kontol Edilen
-0.02
0.8
15
-0.04 0.6
10 0.4
-0.06
0.2
5
-0.08
0
Imaginary Axis
-0.1
0 1 2 3 4 5 0 1 2 3 4 5
0
-10 0.8
0.1
0.6
-15
0.05
0.4
-20 0.2
0
0
-0.05
-25 -20 -15 -10 -5 0 5 -0.2
Real Axis
-0.1 -0.4
0 1 2 3 4 5 0 1 2 3 4 5
Zaman (sn) Zaman (sn)
0
0
-1
-0.2
-2
-3 -0.4
0 5 10 15 20 25 30 0 5 10 15 20 25 30
3.143
3.142
pi
π
Açı (Radyan)
3.141
3.14
Denge durumundaki
sarkacın açı-açısal hız grafiği
3.139 (30 sn'lik veri)
6. Teşekkür
“5 eksen CNC frezeleme operasyonlarında işlenen yüzeyin
kalitesini proses optimizasyonu ile arttıran bir sistem
geliştirme” isimli DPT projesine, sağladığı donanım
katkılarından dolayı teşekkür ederiz.
Şekil 21: Değişkenlerin Filtrelenmesi
7. Kaynakça
Şekil 21’de ölçüm bloğundan gelen bilgiler alçak geçiren
filtrelerden geçtikten sonra nümerik olarak türevleri alınmakta [1] M. Bugeja, “Non-Linear Swing-Up and Stabilizing
ve tekrar filtrelenmektedir. Blok çıkışında gerekli durum Control of an Inverted Pendulum System”, EUROCON
değişkenleri elde edilmiş ve filtrelenmişlerdir. 2003 Ljubljana, Slovenia.
[2] N. Muskinja ve B. Tovornik, “Swinging Up and
Stabilization of a Real Inverted Pendulum”, IEEE
TRANSACTIONS ON INDUSTRIAL ELECTRONICS,
VOL. 53, NO. 2, APRIL 2006.
[3] A.K. Stimac, “Standup and Stabilization of the Inverted
Pendulum” , Massachusetts Institute of Technology, June
1999.
[4] W. Zhong and H. Röck, "Energy and passivity based
control of the double inverted pendulum on a cart,"
presented at IEEE Conference on Control Applications,
2001.
[5] F. Farahmand, A. Elahi, R. Sedeh, “Swinging Up And
Şekil 22: e(t) Hata Sinyallerinin Elde Edilmesi
Stabilizing A Pendulum (Gyrobot)”, 13th Annual
Şekil 22’de durum değişkenlerinin referans değerleri ile (International) Mechanical Engineering Conference –
karşılaştırılmaları ve her durum değişkeni için hata May 200 Isfahan University of Technology, Isfahan, Iran.
sinyallerinin elde edilmeleri görülmektedir. Şekil 23’de ise [6] K. Craig, S. Awtar, “Inverted Pendulum Systems: Rotary
sarkaç açısına bağlı olarak kontrolörün seçiminin gerçekleştiği And Arm-Driven A Mechatronic System Design Case
algoritma görülmektedir. Study”, Mechatronics, Vol. 12, pp. 357-370, 2001.
[7] A. MIRZA, “Inverted Pendulum”, Journal of AMSE,
Vol. 55, No 3,4- Dec, 2000, France.
[8] S. Nundrakwang, T. Benjanarasuth, J. Ngamwiwit ve N.
Komine, “Hybrid PD - Servo State Feedback Control
Algorithm for Swing up Inverted Pendulum System”,
ICCAS2005 June 2-5, KINTEX, Gyeonggi-Do, Korea.
[9] A. ÖZBEY, “Bir Ters Sarkacın Gözlemleyicili Tam
Durum Geri Beslemesi İle Kontrolü”, II. Mühendislik
Bilimleri Genç Araştırmacılar Kongresi 17–19 Kasım 2005,
İstanbul.
Şekil 23: Kontrolör Seçimi [10] M. E. Arı, ”Stabilization Of An Inverted Pendulum By
Using A Fuzzy Controller”, Middle East Technical
University, September 1995, Ankara.
5. Sonuçlar [11] S. Kizir, H. M. Ertunç, “Mikro Kontrolör Tabanlı PID
Kontrol sistemlerinin örnek problemlerinden biri olan arabalı Kontrol Sistemi Eğitim Seti”, Otomatik Kontrol Ulusal
ters sarkaç sistemi deney düzeneği olarak hazırlanmıştır ve Toplantısı, TOK’06, 6-8 Kasım 2006, Ankara.
sarkacın üst denge noktasına ulaştırılması ve bu noktada [12] N. S. Nise, “Control Systems Engineering”, Wiley, 2004.