Professional Documents
Culture Documents
PA10 Endüstriyel Robotun 3 Ekleminin Pasif Olma Temelli Kontrolü
PA10 Endüstriyel Robotun 3 Ekleminin Pasif Olma Temelli Kontrolü
2
Kontrol Mühendisliği Bölümü
İstanbul Teknik Üniversitesi, İstanbul
goren@elk.itu.edu.tr
Burada u(t) kaynak miktarı olup aşağıdaki şekilde olarak tanımlanır. ‘Q’ ise belli bir potansiyelden üretilemeyen
tanımlanır [2]: bütün kuvvetler olup içerisinde Rayleigh kayıp fonksiyonunu
da barındırır [1].
∀u , ∀T ≥ 0 & ∀x0 ∈ \n (2)
Bu durumda Euler-Lagrange sistemleri aşağıdaki
Bu durumda depo fonksiyonu (1)’deki gibi yazılan sistem sebeplerden dolayı Pasif olma temelli kontrol kuramının
(3) kaynak miktarına göre kayıplıysa pasiftir denir. uygulanmasına uygun sistemlerdir. Özet olarak;
w(u , y ) = u T y (3) • Euler-Lagrange sistemleri pasiftir. Eğer kayıplı ise ve
uygulanan kontrol işareti sınırlı ise kararlı sistemlerdir.
• Euler-Lagrange sistemler için kayıp ve depo fonksiyonları ⎡− sin (θ1 )sin (θ2 )lc3 − cos (θ1 )l2 cos (θ2 ) cos(θ1 )lc3 0⎤
⎢ ⎥
tanımlanabilir. Jv3 = ⎢⎢ cos (θ1 )sin (θ2 )lc3 − sin (θ1 )l2 cos (θ2 )sin (θ1 )lc3 0⎥⎥
⎢ 0 − sin (θ2 )lc3 0⎥⎥⎦
⎢⎣
3. Sistem Modeli ve Kontrol Algoritması ⎡0 − sin (θ1 ) cos (θ1 )sin (θ2 )⎤
⎢ ⎥
Bu çalışmada, pasif olma temelli kontrol kuramı PA-10 J ω3 = ⎢⎢0 cos (θ1 ) sin (θ1 )sin (θ2 )⎥⎥ (10)
endüstriyel tipte bir robot koluna uygulanacaktır. PA-10 robot ⎢1 ⎥
kolunun ilk üç ekleminin ilkesel şeması Şekil-1’de verilmiştir. ⎢⎣ 0 cos (θ2 ) ⎥⎦
Genelleştirilmiş atalet matrisi D(q) aşağıdaki gibi elde
edilir[3]:
⎡ n ⎤
{
D (q ) = ⎢ ∑ mi Jvi (q ) Jvi (q ) + J ωi ( q) Ri ( q) I i Ri ( q) J ωi ( q) ⎥
⎢⎣ i =1
T T T
} ⎥⎦
Ayrıca sistemin potansiyel matrisi ‘P’ ise[3],
n
P = ∑ mi g T rci
i =1
+.5(.097sin(-2θ1 + 2θ2 ) + .066sin(2θ1 - 2θ3 ))θ3 Bu ilişkiden görüldüğü gibi, konum kontrolü yapılmak
istendiği zaman şekillendirilmesi gereken fonksiyon, depo
-.5(-.033sin(2θ1 - 2θ3 + θ2 ) - .033sin(-2θ1 + 2θ3 + θ2 ))θ2 )θ2 fonksiyonunun potansiyel enerji bileşeni olur. Ayrıca sisteme
+((-.033sin(2θ1 - 2θ3 + θ2 ) - .033sin(-2θ1 + 2θ3 + θ2 ))θ3 uygulanacak kontrol işareti bu sistemi asimptotik kararlı hale
getirmelidir. Bu şekillendirme yapılırken öncelikle potansiyel
-.5(.0165sin(2θ1 - 2θ3 + 2θ2 ) - .033sin(2θ1 - 2θ3 )
enerjinin tek ve bütünsel bir minimuma sahip olması
-.0165sin(-2θ1 + 2θ3 + 2θ2 ))θ2 )θ3 sağlanmalı ardından da sisteme sönüm eklenerek sistemin
kayıplı dolayısı ile kararlı olması garantilenmelidir.
C31 = (.016cos(θ2 ) - .5045sin(2θ2 )θ3 )θ1 + (.008cos(θ2 ) Sistemin potansiyel enerjisinin bütünsel minimumu
+.5(-.033sin(2θ1 - 2θ3 + θ2 ) - .033sin(-2θ1 + 2θ3 + θ2 ))θ1 sistemin istenen konum noktası olmalıdır. Bu durumda
+.00825cos(2θ1 - 2θ3 + θ2 ) - .00825cos(-2θ1 + 2θ3 + θ2 ) sistemin potansiyel enerjisi aşağıdaki gibi değiştirilmelidir:
1
-.2892sin(θ2 )θ3 )θ2 + (.008cos(θ2 ) + .5(.0165sin(2θ1 - 2θ3 + 2θ2 ) P d = K p q (19)
2
-.033sin(2θ1 - 2θ3 ) - .0165sin(-2θ1 + 2θ3 + 2θ2 ))θ1 Kontrol işareti sistemin potansiyel enerjisini
-.004125cos(2θ1 - 2θ3 + 2θ2 ) + .00825cos(2θ1 - 2θ3 ) biçimlendireceği için aşağıdaki biçimde olması gerektiği
+.01575 - .007750cos(2θ2 ) - .004125cos(-2θ1 + 2θ3 + 2θ2 ) kolaylıkla görülebilir:
∂P (qi ) ∂P (qi )
+.008sin(θ2 )θ3 )θ3 τi = − (20)
∂qi qi
Sisteme (20) de verilen kontrol işareti uygulandığında
kapalı çevrimli sistemin depo fonksiyonu bütünsel tek bir
minimuma sahip olur. Ancak bu kontrol işareti tek başına
sistemin kayıplı olmasını garantilemez. Bu nedenle kontrol
işaretine sönüm ekleyerek sistemin kayıplı olmasını sağlamak
gerekir. Bu durumda sistemin asimptotik kararlı olması
garantilenmiş olur. Sönüm terimi eklenmiş kontrol işareti de
aşağıdaki şekilde ifade edilebilir:
∂P (qi ) ∂P d (qi )
τi = − − K D qi (21)
∂qi ∂qi
(21)'deki kontrol işareti her bir eklem için ayrı ayrı
türetilirse:
τ1 = 0 − K P1q1 − K D1q1
τ 2 = 3.496cos (θ2 ) − K P 2 q2 − K D 2 q2 (22)
τ 3 = 0 − K P 3q3 − K D 3q3
ilişkileri elde edilir.
Uygulanan bu kontrol işaretleri ile her bir eklemin ayrı
ayrı istenen denge noktalarına asimptotik kararlı bir şekilde Şekil 2: Eklemlerin bozucu etkisi olmadan çıkışı.
getirilmesi sağlanır. Bu aşamadan sonra uygun kontrol
parametreleri seçilmeli ve kapalı çevrimli sistemin (23)'de verilen parametreler için kol kütlelerinin
dayanıklılık sınaması yapılmalıdır. bilinmezliğinin +%20 olması durumunda eklemlerin
konumlarının değişimi Şekil-3'de verilmiştir.
4. Benzetim Sonuçları
Bu bölümde, bir önceki bölümde elde edilen kontrol
kuralları sisteme aşağıdaki parametreler için uygulanmış ve
çeşitli model bilinmezlikleri altında benzetim ile çeşitli
sınamalar yapılmış ve elde edilen sonuçlar verilmiştir.
K P1 = 4 K D1 = 2
K P 2 = 8 K D 2 = 3.3 (23)
K P3 = 4 K D3 = 2
Sistemin başlangıç koşulları aşağıda verildiği şekildedir:
θ1 = 0
θ2 = −π / 2 (24)
θ3 = 0
Sisteme uygulanan referans işaretin matematiksel ifadesi
aşağıda verilmiştir:
⎧
⎪10sin (2πt ) t < 1
R=∫ ∫ ⎪ ⎨ dt (25)
⎪
⎪
⎩ 0 t >1
Şekil 3: Kol kütlelerinin bilinmezliğinin +%20 olması
Uygulanan işaretin ve çıkış işaretlerinin şekillerde
durumunda eklemlerin konumlarının değişim.
gösterimi aşağıdaki şekildedir:
(23)'de verilen parametreler için kol kütlelerinin
bilinmezliğinin +%30 olması durumunda eklemlerin
konumlarının değişimi Şekil-4'de verilmiştir. Görüldüğü gibi
kütlelerin bilinmezliğinin +%30 olması durumunda yer
çekimi kuvvetlerinin etkilediği ikinci eklem sürekli hal hatası
(23)'de verilen parametreler için hiçbir bozucu ve model yapmaya başlamıştır. Bu nedenle bu kontrol yöntemi ile
bilinmezliği etkisi olmadan eklemlerin konumlarının değişim kontrol edilen sistem öngörülen kütlenin +%20 civarına kadar
eğrisi Şekil-2'de verilmiştir. olan bilinmezlikler altında, bu bilinmezlikler robot koluna
etkiyen yükler de olabilir, kabul edilebilir düzeyde bir
davranış göstermektedir.
Şekil 4: kol kütlelerinin bilinmezliğinin +%30 olması Şekil 6: Kol kütlelerinin bilinmezliğinin -%30 olması
durumunda eklemlerin konumlarının değişimi durumunda eklemlerin konumlarının değişimi.
(23)'de verilen parametreler için kol kütlelerinin (23)'de verilen parametreler için kol kütlelerinin
bilinmezliğinin -%10 olması durumunda eklemlerin bilinmezliğinin -%60 olması durumunda eklemlerin
konumlarının değişimi Şekil-5'de verilmiştir konumlarının değişimi Şekil-7'de verilmiştir
Şekil 5: Kol kütlelerinin bilinmezliğinin -%10 olması Şekil 7: Kol kütlelerinin bilinmezliğinin -%60 olması
durumunda eklemlerin konumlarının değişimi. durumunda eklemlerin konumlarının değişimi.
(23)'de verilen parametreler için kol kütlelerinin (23)'de verilen parametreler için kol kütlelerinin
bilinmezliğinin -%30 olması durumunda eklemlerin bilinmezliğinin -%80 olması durumunda eklemlerin
konumlarının değişimi Şekil-6'de verilmiştir konumlarının değişimi Şekil-8'de verilmiştir. Görüldüğü gibi
kütlelerin bilinmezliğinin -%80 olması durumunda bütün
eklemler aşım yapmaya başlamıştır. Özellikle ikinci eklemin
hareketlerinden coriolis ve merkezcil kuvvetler sebebiyle
doğrudan etkilenen birinci eklem %100 civarında aşım
yapmaktadır. Bu nedenle bu kontrol yöntemi ile kontrol
edilen sistem, öngörülen kütlenin -%60 civarına kadar olan
bilinmezlikler altında kabul edilebilir düzeyde bir davranış
göstermektedir.
Şekil 5: Kol kütlelerinin bilinmezliğinin -%80 olması
durumunda eklemlerin konumlarının değişimi.
5. Sonuçlar
Bu çalışmada pasif olma temelli kontrol kuramının robot kolu
üzerinde dayanıklılık özellikleri incelenmiştir. Öncelikle
robot kolunun doğrusal olmayan matematiksel modeli Euler-
Lagrange yöntemi ile çıkartılmış ardından robot kolunu her
bir ekleminin noktadan noktaya kontrol edilmesini sağlayan
kontrol işareti, bir potansiyel enerji fonksiyonunu
biçimlendirecek ve sisteme sönüm atayacak şekilde inşa
edilmiştir. Söz konusu kontrol işareti sistemin nominal
parametreleri kullanarak hesaplanmış olmasına rağmen çeşitli
bilinmezlikleri altında benzetimler yapılmıştır. Sonuç olarak
ele alınan sistem yapısı için, pasif olma temelli kontrol
yönteminin, +%20 ve -%60 kütle bilinmezliği altında
dayanıklı olduğu gözlenmiştir.
6. Kaynakça
[1] H. Goldstein, Classical Mechanics, Addison Wesley,
1980.
[2] R. Ortega, A.Loria, P.J. Nicklasson, H. Sira-Ramiez,
Passivity Based Control of Euler-Lagrange Systems,
Spinger, 1998.
[3] M.W. Spong, S. Hutchinson, M. Vidyasgar, Robot
Modelling and Control, Wiley, 2006.
[4] R. Ortega, R. Gomez-Estern, F. Godrillo, J. Aracil, “On
the Ball and Beam problem: Reguation with guaranteed
transient performance and tracking periodic orbits”
Depto. de Ingenieria de Sistemas y Automatica, 1990.
[5] A. Van der Schaft, L2-Gain and Passivity Techniques in
Nonlinear Control, Springer-Verlag, 2000.
[6] B. Ünver, Artık robot kollarının ters kinematik
problemlerinin çözümü ve gerçeklenmesi, İTÜ, 2005.