Professional Documents
Culture Documents
KOCAELİ ÜNİVERSİTESİ
MÜHENDİSLİK FAKÜLTESİ
MEKATRONİK MÜHENDİSLİĞİ
B d B
Qt t B Qt
VQ B Q lim
dt t
denklemiyle bulunabilir. Bu denklemde Q vektörünün {B} koordinat sistemine göre
belli bir zaman diliminde meydana getirdiği yer değiştirme miktarını (hızını)
bulmak için Q vektörünün {B} koordinat sistemine göre türevi alınmıştır.
{B} koordinat sistemine göre tanımlanan bir hız vektörünü {A} koordinat sistemine
göre hızı, aşağıdaki gibi tanımlanır.
V
A
A B dB
Q Q A B
B R VQ
dt 2
Açısal Hız Vektörü
Doğrusal hız uzayda bir noktanın niteliği hakkında bilgi verirken; açısal hız ise katı
bir cismin veya bu katı cisme yerleştirilen bir koordinat sisteminin niteliğini açıklar.
Şekilde gösterilen açısal hız vektörü {B} koordinat ZA
A
sistemine göre dönmektedir. ΩB açısal hız ZB B
A
XB
ifadesinin büyüklüğü dönme miktarı ile
orantılıdır. Açısal hız ifadesi başka bir koordinat
sistemi olan {C} koordinat sistemine göre YA
YB
YB
{B}
A
VQ A VBO R G A B
A
ZA PBO R G(t)
B R VQ
XB
YA
{A}
3
XA
Anlık Doğrusal ve Açısal Hız
Eğer Q noktası {B} koordinat sistemine göre sabit değilse, yani BVQ ≠ 0 ise, Q
noktasının {A} koordinat sistemine göre dönel açısal hızı aşağıdaki gibi ifade edilir.
A
VQ V
A B
Q
A
B A Q BAR BVQ A B BA R BQ
Denklemde elde edilen ifade {A} ve {B} koordinat sistemlerinin merkezleri çakışık
olduğunda geçerlidir. Eğer bu iki koordinat sisteminin merkezleri çakışık değilse
ayrıca {B} koordinat sistemi {A} koordinat sistemine göre hareket ediyorsa, bu
durumda genel denklemi tanımlayabilmek için bu iki koordinat sistemlerinin
merkezleri arasındaki uzaklığı da ( AVBORG ) göz önünde bulundurmamız gerekir. Bu
durumda {B} koordinat sistemine göre sabit bir vektörün {A} koordinat sistemine
göre hızı genel formda aşağıdaki gibi tanımlanabilir.
VQ AVBORG BAR BVQ A B BA R BQ
A
Yukarıda elde edilen genel denklemde, Q vektörü {B} koordinat sistemine göre
hareket etmektedir. Ayrıca {B} koordinat sisteminin {A} koordinat sistemine göre
hem doğrusal hem de açısal hızı vardır.
4
Robot Manipülatörlerinin Komşu Bağları Arasındaki Hız İlişkisi
Aşağıdaki iki serbestlik dereceli robot komşu iki bağdan oluştuğundan ard arda
gelen her bağ birbirine göre açısal ve doğrusal hızlara sahiptir. Her bir bağın
hızlarını bulmak için ana koordinat sisteminden başlanarak bir dizi işlem
gerçekleştirilir. Bilindiği gibi bir eklemin açısal dönmesi her zaman Z ekseninde
gerçekleştiğinden, i+1. eklem etrafında gerçekleşen i+1. bağın açısal hızı aşağıdaki
gibi tanımlanır.
i 1
0
i 1 i 1Zˆ i 1 0
i 1
Denklemdeki ifadeyi, {i.} koordinat sistemi cinsinden bulmak için i+1iR ile çarpalım.
Bu ifadeye bir de bağ i’nin açısal hızı olan iwi ifadesini eklersek, bağ i+1’in açısal
hızını elde ederiz.
i
i1 i i i1iRi1 i1Zˆ i 1
5
Denklemdeki ifadeyi {i+1.} koordinat sistemi cinsinden ifade etmek için her iki
tarafı i+1iR ile çarpalım.
i 1
i R i i 1 i 1i 1 i 1 i i1R ii i 1 i 1Zˆ i 1
i 1
{i+1.} koordinat sisteminin doğrusal hızı ise, {i.} koordinat sisteminin doğrusal
hızına {i.} koordinat sisteminin dönmesinden kaynaklanan yeni bir elemanın
eklenmesiyle bulunur. Bu yeni eleman ii i Pi 1 ifadesidir.
i
vi 1 i vi i i i Pi 1
i 1
vi 1 i i1R i vi 1 i i1R i vi i i i Pi 1
0
v 0
Yukarıdaki ilişki 0 J q q şeklinde de gösterilebilir.
0 0
7
Jakobiyen matrisinin tersi alınabiliyorsa, bu durumda eklem değişim oranları
Kartezayen uzaydaki hızlar cinsinden ifade edilebilir.
q J 1 q
J −1 ifadesi tekil noktalarda elde edilemez, eğer J −1 her zaman elde edilebiliyorsa,
bu ifade robot kontrolünde kullanılabilir.
İteratif yöntem
Bu yöntemle hem açısal hem de doğrusal hızlardan oluşan Jacobian matrisi
bulunabilir. 8
ÖRNEK 5.1
Şekilde görülen RR eklem yapısına sahip düzlemsel robotun uç işlevcisinin
doğrusal ve açısal hızlarını eklem değişkenleri cinsinden bulunuz.
ÇÖZÜM 5.1
c 2 s 2 0 0 0 0 0 0
2
2 12 R 11 2 2 Zˆ 2 s 2 c 2 0 0 2 0 1 0 0 0
0 0 1 1 1 1 2 1 2
Uç işlevcisinin kendi ekseni etrafındaki doğrusal hızı aşağıdaki gibi elde edilir.
c12 0
s12 l1s 21
0
v3 30 R 3v3 10 R 21R 32 R 3v3 s12
c12 0 l1c 21 l2 1 2
0 0 1 0
c12l1s 21 s12l1c 21 s12l2 1 2
s12l1s 21 c12l1c 21 c12l2 1 2
0
Yukarıdaki denklem aşağıdaki gibi sadeleştirilebilir.
l1 s11 l2 s12 1 2
0
v3 l1c11 l2 c12 1 2
0
14
Doğrudan Türev Yöntemi
Örnek 5.1’deki düzlemsel robotun Jakobiyen matrisini doğrudan türev alma
yöntemini kullanarak bulalım. Öncelikle 03T matrisinin bulunması gerekmektedir.
c1 s1 0 0 c 2 s 2 0 l1 1 0 0 l2 c12 s12 0 l1c1 l2c12
s c1 0 0 s 2 c 2 0 0 0 1 0 0 s12 c12 0 l1s1 l2 s12
3T 1T 2T 3T
0 0 1 2 1
0 0 1 0 0 0 1 0 0 0 1 0 0 0 1 0
0 0 0 1 0 0 0 1 0 0 0 1 0 0 0 1
px px
q q2 q
vx 1 1
v
y p y p y q2
q1 q2
l1c1 l2 c12 l1c1 l2c12
vx 1 2 l s l s
0
l2 s12 1
v 1 1 1 2 12
y 3 l1s1 l2 s12 l1s1 l2 s12 2 l1c1 l2 c12 l2c12 2
1 2 15
5.4.3. Vektörsel Çarpım Yöntemi
Genel olarak vektörsel çarpım yöntemine göre i. eksene ait Jakobiyen bulunurken,
diğer bütün eksenler dondurularak sadece i. eksene ait işlem yapılır. Bütün
eksenler için aynı işlem tekrarlanarak toplam Jakobiyen matris bulunur. Örneğin,
Jakobiyen matrisin birinci kolonu bulunurken diğer eklemler sabit tutulup 1.
ekleme göre kısmi türev işlemi gerçekleştirilir. Aşağıda vektörsel çarpım yöntemi
sembolik olarak gösterilmiştir.
0 varaç _ ucu x 0 ˆ
Z i 0 Paraç _ ucu 0Piorg x 0
0
araç _ ucu y
v
0 ˆ
Z 0
P 0
P
i araç _ ucu iorg y
0
0 varaç _ ucu z 0 Zˆ 0 P
i araç _ ucu 0
Piorg z
i
araç _ ucu x 0
0
Z ix
0 araç _ ucu y 0
Z
0 iy
0 araç _ ucu z 0
Z iz 0
Zi ,ana koordinat sistemine göre i. koordinat sistemindeki birim Z vektörü,
0
Piorg , ana koordinat sistemine göre i. koordinat sisteminin konumu, 0Paraç_ucu ,
ana koordinat sistemine göre uç işlevcinin konumunu göstermektedir.
16
Prizmatik eklemler için açısal ve doğrusal hızlar aşağıdaki gibidir.
0
vi 0d i 0 Zˆ i 0
i 0
Örnek 5.1’de kullanılan şekildeki robotun Jakobiyen matrisini vektörsel çarpım
yöntemini kullanarak bulalım. Doğrusal hızlar için ana koordinat sistemine göre
tanımlanan Jakobiyen matris ifadesini hatırlayalım.
0 v3 x
0 0 ˆ
v3 y
Z 1 0
P
3 0
P1org 0
Zˆ 2 0 P3 0P2 org
0
0
P3 ifadesi robotun ana koordinat sistemine göre uç işlevcisinin konumunu
gösterir ve 03T denkleminin dördüncü kolundan elde edilir.
l1c1 l2 c12
0
P3 l1s1 l2 s12
0 17
0
Piorg ifadesi sıfır numaralı koordinat sistemi ile 1 numaralı koordinat sistemi
arasındaki uzaklığı göstermektedir. Bu iki koordinat sistemi üst üste olduğundan
0
P1org = 0 0 0 𝑇 olur. Bu ifade aynı zamanda 01T matrisindeki 4. kolundur.
0
𝑍መ1 ifadesi 𝑖𝑍𝑖 = 01R 𝑖𝑍𝑖 eşitliğinden bulunur.
c1 s 1 0 0 0
0
Z1 10R1Z1 s1 c1 0 0 0
0 0 1 1 1
Jakobiyen matrisin ikinci kolonunu elde etmek için aşağıdaki denklemi yazalım.
0
Zˆ 2 0 P3 0P2 org
18
0
Z2org ve 0P1org ifadesini elde etmek için 02T dönüşüm matrisini yazalım.
c1 s1 0 0 c 2 s 2 0 l1 c12 s12 0 l1 c1
s c1 0 0 s 2 c 2 0 0 s12 c12 0 l1 s1
0
T 0 1
T T 1
2 1 2
0 0 1 0 0 0 1 0 0 0 1 0
0 0 0 1 0 0 0 1 0 0 0 1
1 0 0 1 0 0
ÖRNEK 5.2
20
Bu durumda açısal ve doğrusal hızlardan kaynaklanan Jakobiyen matrisi aşağıdaki
gibi elde edilir.
l1 s1 l 2 s12 l 2 s12
0
J l1c1 l 2 c12 l 2 c12
1 1
ÖRNEK 5.2
Şekilde katı gövde yapısı verilen RRP robotun aşağıdaki yöntemleri kullanarak ana
koordinat {0} sistemine göre Jakobiyen matrisini bulunuz.
a) İteratif yöntem.
b) Doğrudan türev alma yöntemi
c) Vektörsel çarpım yöntemi
21
ÇÖZÜM 5.2
a) İteratif yöntem kullanarak Jakobiyen matrisini bulalım. Bunu için öncelikle
şekildeki robotun dönüşüm matrislerini hatırlayalım.
c1 s1 0 0
s c1 s 1 0 0
c1 0 0 s
0
T 1 0
R 1 c1 0 0
P 0
1
0 0 1 h1
1 1
0 0 1 h1
0 0 0 1
c 2 s 2 00 0
0 c 2 s 2 0 d
1 d 2
1
P
1 2
0 2
2T 2R 0
1 1
0
s 2 c 2 0 0 0
s 2 c 2 0
0 0 0 1
1 0 0 0 0
0 0 1 0 0
1 (l 2 d 3 ) (l d )
0 1
2
3T
P
3 R 0
2
2 3
2
3
0 1 0 0
0 1 0 0
0 0 0 1
22
i=0 için açısal hız,
c1 s1 0 0 0 0
i 1 i i1R ii i 1 i 1Zˆi 1
i 1 1
1 01R 00 1 1Zˆ1 s1 c1 0 0 1 0 0
0 0 1 0 1 1
doğrusal hız,
c1 s1 0 0 0 0 0
i 1
vi 1 i 1
i R i vi ii i Pi 1 1
v1 01R ( 0 v0 00 0 P1 ) s1 c1 0 0 0 0 0
0 0 1 0 0 h1 0
0 s 2 (l2 d3 ) c 2
3
J
0 s1 0
0 c1 0
1 0 0
vz 1 d3 0 s 2 (l2 d3 ) c 2 d3
pz pz pz
2 d3
1
0 s1 0
0
J 0 c1 0
29
1 0 0
Sonuçta hem açısal hem de doğrusal hızlardan kaynaklanan jakobiyen matrisi
aşağıdaki gibi olur.
s1s 2 (l2 d3 ) c1d 2 c1c 2 (l2 d3 ) c1s 2
c s (l d ) s d s1c 2 (l2 d3 ) s1s 2
1 2 2 3 1 2
0 s 2 (l2 d3 ) c 2
3
J
0 s1 0
0 c1 0
1 0 0
ÖRNEK 5.3
30
31
ÇÖZÜM 5.3
a) İteratif yöntem kullanarak Jakobiyen matrisini bulmak için öncelikle şekildeki
robotun dönüşüm matrislerini hatırlayalım.
0 0 1 h1 s 2 c 2 0 0 0 0 1 0 0 0 1 0
0 0 0 1 0 0 0 1 0 0 0 1 0 0 0 1
c1 s 1 0 c 2 s 2 0 c 3 s 3 0
1 0 0
1 R s 1
0
c1 0
2R 0
1
0 1
3 R s 3
2
c 3 0 1 0
4 R 0
3
0 0 1 s 2 c 2 0 0 0 1 0 0 1
h1 0 0 0
0 0
i=0 için açısal hız 11 01R 00 1 1Zˆ1 0 , doğrusal hız 1v1 01R ( 0 v0 00 0 P1 ) 0
1 0
i=1 için açısal hız, doğrusal hız
s 21 d 21c 2
2
2 12 R 11 2 2 Zˆ 2 c 21 2
v2 12 R ( 1v1 11 1P2 ) d 21s 2
2 0
s 2 c31 c 2 s31
i=2 için açısal hız, 33 23 R 22 3 3Zˆ3 s 2 s31 c 2 c31
2 3
0 l3c 23 l2 c 2 l3c 23
3
J ( )
0 s1 s1
0 c1 c1
1 0 0
34
px px px
2 3
1
vx l s c l s c d 2 c1 l3c1s 23 l2c1s 2 l3c1s 23 1
v p y p y p y 1 3 1 23 2 1 2
2 l3c1c 23 l2 c1c 2 d 2 s1 l3 s1s 23 l2 s1s 2
l3 s1s 23 2
y 2 3
vz 1 3 0 l3c 23 l2 c 2 l3c 23 3
pz pz pz
2 3
1
0 s 1 s 1
Robotun açısal hızlardan kaynaklanan Jakobiyen matrisi: 0 J ( ) 0 c1 c1
1 0 0
0 l3c 23 l2 c 2 l3c 23
3
J ( )
0 s1 s1
0 c1 c1
1 0 0
300 150
240 120
Hız (derece/saniye)
Konum (derece)
180 90
120 60
60 30
0 0
0 0.5 1 1.5 2 2.5 3 0 0.5 1 1.5 2 2.5 3
Zaman (saniye) Zaman (saniye)
20
10
18
9
16
8
14
7
Konum (derece)
Hız (drecece/saniye)
12
6
10
5
8
4
6
3
4
2
2
1
0
0 0.5 1 1.5 2 2.5 3
Zaman (saniye) 0
0 0.5 1 1.5 2 2.5 3
Zaman (saniye)
18
9
15
7.5
12
Konum (derece)
Hız (derece/saniye)
9
4.5
6
3
3
1.5
0
0 0.5 1 1.5 2 2.5 3 0
Zaman (saniye) 0 0.5 1 1.5 2 2.5 3
Zaman (saniye)
ÇÖZÜM 5.4
y2
1 0 0 0 1
1
d2
2 0 0 d2 0
z0,1
x 0,1
3 90 l1 d3 0
y 0,1
0
3T ileri kinematik matrisleri
v p y p y p y 1
y d 2 ise v y l1c1 d 3 s1 0 c1 d 2
d 2 d3
vz 1 d3
vz 0 1 0 d3
p pz pz
z
1 d 2 d3
l1 s 2 0
3
J
l1c 2 l 2 l 2
l2
2
Jakobiyen matrisin determinantını bulalım.
1
l1s 2 0
DET J l1l2 s 2
l1 l1c 2 l2 l2
Bilinen Kartezyen hızlar ve eklem açıları cinsinden herhangi bir t anındaki eklem
hızlarını bulmak için 𝜒ሶ = 𝐽𝑄ሶ eşitliğinin her iki tarafını da 𝐽−1 ile çarpalım.
J 1 J 1 JQ ise J 1 J I Q J 1
42
ÖRNEK 5.5
Şekildeki robotun (örnek 5.4) t=0.78’nci saniyedeki Kartezyen hızları ve eklemlerin
konumları aşağıda verildiğine göre her bir eklemin hızını bulunuz.
d2
ÇÖZÜM 5.5
1 vx
1
1
Q J 1 ise d
2 J v
y
d3 vz
Jakobiyen matrisinin tersini alalım.
c1 s1
0
l1s1 d3c1 0 s1
d3 d3
J l1c1 d3 s1 0 c1 ise J 1 0 0 1
0 1 0 l1c1 d3 s1 l1s1 d3c1
0
d3 d3 43
Jakobiyen matrisin tersini denklemde yerine koyalım.
c1 s 1
1 0 v
x
d3 d3
d 2 0 0 1 v y
d3 l1c1 d 3 s1 l1 s1 d 3 c1
0 v z
d3 d3
cos(58.7) sin(58.7)
0
1 2.93 2.93 3252 158.6
d2 0 0 1 2534.7 8.82
d3 26 cos(58.7) 2.93 sin(58.7) 26 sin(58.7) 2.93cos(58.7) 8.82 7.9
0
2.93 2.93
44
Bu denklemden yararlanarak A𝐽 𝑄 ifadesini bulalım. Bilindiği gibi
Av BA R B v BA R 0 Bv
A A B A B
B R 0 B R
𝐵
𝑣 𝐵 ሶ
yukarıdaki ifadede 𝐵 = 𝐽𝑄 yazarsak aşağıdaki denklemi elde ederiz.
𝜔
𝐴
𝑣
Ayrıca 𝐴 = 𝐴𝐽𝑄ሶ olduğundan yukarıdaki ifadeyi aşağıdaki gibi düzenleyelim
𝜔
BA R 0 B
A
JQ A
JQ
0 B
R
Denklemin sağ ve sol tarafındaki ifadeleri sadeleştirilirse {B} koordinat sistemine
göre ifade edilmiş Jakobiyen {A} koordinat sistemine göre aşağıdaki gibi tanımlanır.
BA R 0 B
A
J A
J
0 B R 45
Av A
A J Q Q
Aynı zamanda olduğundan yukarıdaki ifadeyi aşağıdaki gibi
düzenleyelim.
BA R 0 B
A
J Q Q
A
J Q Q
0 B R
46