You are on page 1of 30

T.C.

KOCAELİ ÜNİVERSİTESİ

FEN BİLİMLERİ ENSTİTÜSÜ


ENDÜSTRİYEL ROBOTLARIN MODELLENMESİ

Prof. Dr. Serdar KÜÇÜK 1


3.1. Giriş
Geometrik bir sistemin yapısını ve hareketlerini inceleyen bilim dalına kinematik
denir. Bir sistemin belirli şartlar altında nasıl hareket ettiğini anlayabilmek için bu
sistemin kuvvet atalet ve enerji gibi büyüklüleri yani dinamiği hakkında bilgi sahibi
olmak gerekir. Robotun ileri yön kinematiği (forward kinematics), robot bağlarının
konumları, hızları ve ivmeleri arasındaki ilişkiyle ilgilenir. Bir seri robot, ana
çerçevesinden araç çerçevesine doğru birbirine prizmatik veya dönel eklemlerle
tutturulmuş seri bağlardan oluşur. Eğer her ekleme bir koordinat sistemi
yerleştirilirse, komşu iki eklem arasındaki ilişki bir dönüşüm matrisi ile ifade edilir.
İlk ekleme ait dönüşüm matrisi, ilk eklemle ana çerçeve arasında bir ilişki
tanımlarken son ekleme ait dönüşüm matrisi ise uç işlevcisi ile son eklem arasında
bir ilişki tanımlar. Arka arkaya sıralanan bu eklem dönüşüm matrislerinden
yararlanarak ana çerçeveyle araç çerçevesi arasında bir ilişki tanımlanır. Bu ilişkiye
ileri kinematik denir ve araç çerçevesinin yönelimini ve konumunu ana çerçeveye
göre ifade eder ve aşağıdaki gibi gösterilir.
0
NT = 01T 21T 23T N −N1 T

2
Her bir eklem matrisi bir eklem değişkeninin fonksiyonudur. 𝑁0𝑇dönüşüm matrisi
ise N tane eklemin birer fonksiyonudur. Bir robotun uç işlevcisinin çalışma
uzayında serbestçe hareket edebilmesi için 6 serbestlik derecesi yeterlidir.

3.2. Eklem Değişkenlerinin Belirlenmesi


Robotların eklem değişkenlerinin belirlemek için bir çok kinematik yöntem
geliştirilmiştir. Kinematik problemlerin çözümü, Kartezyen üç boyutlu ve
Kartonyum dört boyutlu olmak üzere iki farklı uzayda gerçekleştirilir.

Kartezyen uzayda üstel yöntem (exponential method), Pieper-Roth yöntemi


başvurulan yöntemlerden bazılarıdır. Fakat çoğunlukla bir robotun eklem
değişkenlerinin belirlenmesinde en fazla tercih edilen yöntem kısaca D-H olarak
gösterilen Denavit-Hartenberg yöntemidir.

3
3.2.1. Denavit-Hartenberg Yöntemi
Denavit-Hartenberg yönteminde dört ana değişken kullanılarak robot kinematiği
çıkarılır. Bu değişkenler,

1. İki eksen arasındaki bağ uzunluğu (link length) 𝑎𝑖−1


2. (i-1) ile i eksenleri arasındaki bağ açısı (link twist) (𝛼𝑖−1 )
3. Üst üste çakışan bağlar arasındaki eklem kaçıklığı (joint offset) (𝑑𝑖 )
4. İki bağ arasında oluşan eklem açısı (joint angle) (𝜃𝑖 )’dir.

Bu dört değişkene D-H değişkeni denir. Bu değişkenleri belirlemek için, öncelikle


robotun dönme eksenleri belirlenir ve dönme eksenleri bağlardan bir fazla olacak
şekilde numaralandırılır.

4
İkinci adım olarak bu eksenlerin her birine bir koordinat sistemi yerleştirilir ve bağ
dönme ekseni koordinat sisteminin Z ekseni kabul edilir.

Üçüncü adımda ise 𝑋𝑖−1 yönünde uzanan 𝑍𝑖−1 ile 𝑍𝑖 arasındaki dik uzaklık 𝑎𝑖−1
bağ uzunluğu olarak belirlenir.

Zi −1 Zi
Yi
Yi −1
ai −1

X i −1

Xi 5
Dördüncü adımda 𝑋𝑖−1 ile 𝑋𝑖 arasında 𝑍𝑖 boyunca uzanan üst üste çakışan bağlar
arasındaki mesafe 𝑑𝑖 (bağ kaçıklığı) olarak belirlenir.

Beşinci adımda 𝑍𝑖−1 ile 𝑍𝑖 dönme eksenleri arasında oluşan açı 𝛼𝑖−1 bağ açısı
olarak belirlenir.

6
Son olarak 𝑎𝑖−1 ile 𝑎𝑖 bağları arasında X ekseni boyunca ölçülen açı 𝜃𝑖 açısı olarak
belirlenir.

7
3.2.2. Eklemlere Koordinat Sistemi Yerleştirilmesi
Eklemlere koordinat sistemi yerleştirilirken aşağıdaki işlemler gerçekleştirilir.
• Öncelikle eklem eksenlerinin dönme veya kayma yönleri belirlenir. Dönel
eksenler için dönme yönü Z, prizmatik eklemler için kayma yönü Z ekseni
olarak belirlenir.
• Genellikle Z eksenine dik ve kol boyunca olan bağ uzunluğu X ekseni olarak
kabul edilir.
• Z ve X eksenleri belirlendikten sonra sağ el kuralına göre Y ekseni bulunur.

Önemli nokta:
• Bir seri robotun eklemlerine koordinat sistemleri yerleştirilirken birinci eksenin
dönme yönü Z ekseni olarak belirlendikten sonra genellikle bu ekleme X ekseni
döndürüldüğünde komşu iki Z ekseni üst üste çakışacak şekilde bir X ekseni
yerleştirilir.

8
DH Değişkenleri
1. 𝑎𝑖−1 , 𝑍መ𝑖−1 ile 𝑍መ𝑖 arasında 𝑋෠𝑖−1 boyunca belirlenen uzunluktur.

2. 𝛼𝑖−1 , 𝑍መ𝑖−1 ile 𝑍መ𝑖 arasında 𝑋෠𝑖−1 boyunca ölçülen açıdır.

3. 𝑑𝑖 , 𝑋෠𝑖−1 ile 𝑋෠𝑖 arasında 𝑍መ𝑖 boyunca belirlenen uzunluktur.

4. 𝜃𝑖 , 𝑋෠𝑖−1 ile 𝑋෠𝑖 arasında 𝑍መ𝑖 boyunca ölçülen açıdır.

Bu dört değişken kullanarak n serbestlik derecesine sahip bir robotun yalnızca bir
eklemine ait dönüşüm matrisi aşağıdaki gibi elde edilir. Bir dönüşüm matrisi,
3x3’lük bir dönme matrisinden ve 3x1’lik bir konum vektöründen oluşur.
T = Rx ( i−1 ) Dx (ai−1 ) Rz (i ) Dz (di )
i −1
i

1 0 0 0  1 0 0 ai −1   ci − si 0 0  1 0 0 0
0 c − s i −1 0  0 1 0 0   si ci 0 0  0 1 0 0 
iT =
i-1  i −1

0 s i −1 c i −1 0  0 0 1 0  0 0 1 0  0 0 1 di 
    
0 0 0 1  0 0 0 1  0 0 0 1  0 0 0 1
𝑐𝜃𝑖 −𝑠𝜃𝑖 0 𝑎𝑖−1
i−1𝑇 = 𝑠𝜃𝑖 𝑐𝛼𝑖−1 𝑐𝜃𝑖 𝑐𝛼𝑖−1 −𝑠𝛼𝑖−1 −𝑠𝛼𝑖−1 𝑑𝑖
i 𝑠𝜃𝑖 𝑠𝛼𝑖−1 𝑐𝜃𝑖 𝑠𝛼𝑖−1 𝑐𝛼𝑖−1 𝑐𝛼𝑖−1 𝑑𝑖
9
0 0 0 1
3.2.4. Robot Kinematiğinin Çıkarılmasında Uygulanan Genel Kurallar
Sıfır konumunda bulunan robotun ileri yön kinematiği bulma sırası :
1. Robotun her eklemi belirlenerek bu eklemlere koordinat sistemi yerleştirilir.
2. Her eklem için D-H değişkenleri belirlenir.
3. Tablonun her satırında bulunan değişkenler kullanılarak her bir ekleme ait
dönüşüm matrisi elde edilir.
Tabloda yer alan 𝑎𝑖−1 ve 𝛼𝑖−1 robotun hareket etmesiyle değişmeyen sabit
parametreler iken 𝜃𝑖 𝑣𝑒 𝑑𝑖 robotun hareketiyle değişen parametrelerdir. Her bir
eklem için elde edilen 𝜃𝑖 𝑣𝑒 𝑑𝑖 parametrelerinden sadece bir tanesi değişken
olabilir.

10
Robotların ileri yön kinematiği, geometrik ve DH olmak üzere iki farklı yöntem
kullanılarak bulunabilir. Genellikle geometrik yöntem geometrik yapısı basit
robotlar için tercih edilir.

Üç eklemli düzlemsel (planar) basit bir robotun ileri yön kinematiğini hem
geometrik hem de matematik model yaklaşım kullanarak bulalım. Düzlemsel
robotun eklem değişkenleri 𝜃1 , 𝜃2 , 𝜃3 açıları ve bağ uzunlukları ise 𝑙1 , 𝑙2 , 𝑙3
ifadeleridir.

11
1. Geometrik yöntem

P noktasının konumu X ve Y eksenindeki ise 𝑙1 , 𝑙2 𝑣𝑒 𝑙3 bağ uzunluklarının


toplanmasıyla aşağıdaki gibi bulunur.

p x = l1c1 + l2 c(1 +  2 ) + l3c(1 +  2 +  3 )

p y = l1 s1 + l2 s (1 +  2 ) + l3 s (1 +  2 +  3 ) 12


2. DH yöntemini
Öncelikle robotun katı gövde (rigid body) yapısı sıfır konumunda çizilir. Bir robotun
sıfır konumu bütün eklem değişkenlerinin başlangıç konumunda olma durumudur.

Şimdi ise yukarıdaki robotun her eklemine bir koordinat sistemi yerleştirelim. Bu
robotun bütün eklemleri dönel ve bir birine paralel olduğundan eksenlerinin
dönme yönleri de aşağıda görüldüğü gibi aynı olur.

13
Şimdi ise her ekleme bir X ekseni yerleştirelim. Şekilde görüldüğü gibi Z eksenine
dik ve kol boyunca uzanan bağ uzunluğu X ekseni olarak belirlenir.

Son olarak sağ el kuralına göre aşağıda görüldüğü gibi Y ekseni belirlenir.

14
D-H parametreleri:
1. 𝛂𝐢−𝟏 : Z0,1 , Z2 , Z3 ve Z4 eksenlerinin dönme yönleri aynı olduğundan,
i = 1 için  i −1 = 1−1 =  0 = 0  (0 ile 1 arası)
i = 2 için  i −1 =  2−1 = 1 = 0  (1 ile 2 arası)
i = 3 için  i −1 =  3−1 =  2 = 0  (2 ile 3 arası)
i = 4 için  i −1 =  4−1 =  3 = 0  (3 ile 4 arası)

2. 𝐚𝐢−𝟏 : 0 ile 1. eklemler üst üste olduğundan bu iki eklem arasında yani 𝑍መ0 ile 𝑍መ1
arasında 𝑋෠0 boyunca uzanan herhangi bir bağ uzunluğu yoktur.

i = 1 için ai −1 = a1−1 = a0 = 0 ( Zˆ 0 ile Zˆ1 arası)

Z෠ 1 ile Z෠ 2 arasında X
෡1 boyunca 𝑙1 uzunluğu vardır.

i = 2 için ai −1 = a2−1 = a1 = l1 (Zˆ1 ile Zˆ 2 arası)

𝑍መ2 ile 𝑍መ3 arasında X


෡ 2 boyunca 𝐼2 uzunluğu vardır.
i = 3 için ai −1 = a3−1 = a2 = l2 (Zˆ 2 ile Zˆ 3 arası)
𝑍መ3 ile 𝑍መ4 arasında 𝑋෠3 boyunca 𝑙3 uzunluğu vardır.
i = 4 için ai−1 = a4−1 = a3 = l3 (Zˆ 3 ile Zˆ 4 arası) 15
3. 𝐝𝐢 : 0 ile 1. eklemler üst üste olduğundan bu iki eklem arasında yani 𝑋෠0 ile 𝑋෠1
arasında 𝑍መ1 boyunca herhangi bir eklem kaçıklılığı (offset) yoktur.
i = 1 için d i = d1 = 0 ( Xˆ 0 ile Xˆ 1 arası)

𝑋෠1 ile 𝑋෠2 arasında 𝑍መ2 boyunca herhangi bir uzunluk yoktur.
i = 2 için d i = d 2 = 0 ( Xˆ 1 ile Xˆ 2 arası)
𝑋෠2 ile 𝑋෠3 arasında 𝑍መ3 boyunca herhangi bir uzunluk yoktur.

i = 3 için d i = d 3 = 0 ( Xˆ 2 ile Xˆ 3 arası)


𝑋෠3 ile 𝑋෠4 arasında 𝑍መ4 boyunca herhangi bir uzunluk yoktur.

i = 4 için d i = d 4 = 0 ( Xˆ 3 ile Xˆ 4 arası)


4. 𝛉𝐢 : Son olarak bütün eklemler dönel olduğundan

i = 1 için i = 1 i = 2 için i =  2 i = 3 için i =  3

Dördüncü eklemde sadece uç işlevcisi bulunmaktadır. Bu eklem dönel veya prizmatik


olmadığından
i = 4 için  i =  4 = 0
16
Robotların ileri yön kinematiği çıkarılırken uç işlevcisine de bir koordinat çerçevesi
yerleştirildiği unutulmamalıdır.

İleri yön kinematiği çıkarılan robotun üç eklemi de dönel olduğundan doğal olarak
değişkenlerde 𝜃1 , 𝜃2 , 𝜃3 olur.

DH Tablosu

17
Tabloda görülen D-H değişkenlerini aşağıda verilen genel matriste yerine koyup
her bir eklem için bir adet dönüşüm matrisi elde edilir.

 c i − s i 0 ai −1 
 s c c i c i −1 − s i −1 − s i −1d i 
i −1
iT =
 i i −1
 s i s i −1 c i s i −1 c i −1 c i −1d i 
 
 0 0 0 1 

1. Eklem için (i=1),

 c1 − s1 0 0  c1 − s1 0 0 


 s c(0) c c(0) − s (0) 0   s1 c1 0 0 
i −1
iT =
1−1
1T = 1T =
0  1 1
=
 s1s (0) c1s (0) c(0) 0  0 0 1 0
   
 0 0 0 1  0 0 0 1 18
2. Eklem için (i=2 için)
 c 2 − s 2 0 l1  c 2 − s 2 0 l1 
 s c(0) c c(0) − s (0) 0   s 2 c 2 0 0 
i −1
T = 2 −1
T = 1
T =  2 2
=
i 2 2
 s 2 s (0) c 2 s (0) c(0) 0  0 0 1 0
   
 0 0 0 1  0 0 0 1

3. Eklem için (i=3) için


 c3 − s3 0 l2  c3 − s3 0 l2 
 s c(0) c c(0) − s (0) 0   s c3 0 0 
i −1
T = 3−1
T = 2
T =  3 3  =  3
i 3 3
 s3 s (0) c3 s (0) c(0) 0   0 0 1 0
   
 0 0 0 1   0 0 0 1

Uç işlevcisi için (i=4) için

 1 0 0 l3  1 0 0 l3 
0  c(0) 1 c(0) − s(0) 0  0 1 0 0 
i −1
iT =
4 −1
4T = 4T =
3  =
0  s(0) 1 s(0) c(0) 0  0 0 1 0
   
 0 0 0 1  0 0 0 1 19
Yukarıdaki dönüşüm matrislerinin çarpılmasıyla ana çerçeveden araç çerçeveye
doğru 04𝑇 ileri yönlü robot kinematiği aşağıdaki gibi çıkarılır.

T = 01T 21T 23T 34T


0
4

c1 − s1 0 0 c 2 − s 2 0 l1  c 3 − s 3 0 l2  1 0 0 l3 


 s c1 0 0  s 2 c 2 0 0   s 3 c 3 0 0  0 1 0 0 
= 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

 c12 c3 − s12 s3 − s12 c3 + c12 s3 0 l3 (c12c3 − s12 s3 ) + l2c12 + l1c1 
 s c + c s c12 c3 − s12 s3 0 l3 ( s12 c3 + c12 s 3 ) + l2 s12 + l1s1 
=  12 3 12 3

 0 0 1 0 
 
 0 0 0 1 

Denklemde c𝜃12 = 𝑐𝜃1 𝑐𝜃2 − 𝑠𝜃1 𝑠𝜃2 ve s𝜃12 = 𝑠𝜃1 𝑐𝜃2 + 𝑐𝜃1 𝑠𝜃2 ’dir.

20
D-H yönteminden elde edilen 𝑝𝑥 ve 𝑝𝑦 ifadelerini sırayla açı toplamları cinsinden
yazalım.

p x = l3c(1 +  2 +  3 ) + l2 c(1 +  2 ) + l1c1

p y = l3 s(1 +  2 + 3 ) + l2 s(1 +  2 ) + l1s1

Denklemde,
c12 = c(1 +  2 )

s12 = s(1 +  2 )

c12 c 3 − s12 s 3 = c123 = c(1 +  2 +  3 )

s12 c 3 + c12 s 3 = s123 = s (1 +  2 +  3 )

Dikkat edilirse geometrik yöntemden ve D-H yönteminden elde edilen sonuçlar


aynı çıkmıştır

21
ÖRNEK 3.1
Şekilde bir RRP (dönel ‘R’, dönel ‘R’, prizmatik ‘P’) robotunun katı gövde yapısı
veriliyor. Buna göre
a. Her bir ekleme koordinat sistemi yerleştiriniz.
b. D-H değişkenlerini bulunuz.
c. Her bir eklemin dönüşüm matrisini bulunuz.
d. Ana çerçeve ile uç işlevcisi arasındaki ileri kinematiği bulunuz.
e. Bu ileri kinematik denklemin doğru olup olmadığını araştırınız.

22
ÇÖZÜM 3.1

Şekildeki robot iki dönel bir de prizmatik eklemden oluşmaktadır. Bilindiği gibi
prizmatik eklemlerde kayma, dönel eklemlerde dönme yönü Z ekseni olarak
belirlenir. Buna göre şekildeki robotun her bir ekleminin Z ekseni aşağıdaki gibi
belirlenir.

23
𝑍መ0 ile 𝑍መ1 ekseni aynı yönlü olduğundan Son olarak, sağ el kuralına göre
𝑋෠0 ile 𝑋෠1 ekseni de aynı yönlü olur. 𝑍መ0,1 RRP robotunun eklemlerine Y
eksenine 𝑋෠0,1 eksenini öyle yerleştirelim ekseni, aşağıdaki görüldüğü gibi
ki, 𝑋෠0,1 ekseni döndürüldüğünde 𝑍መ0,1 ve yerleştirilir.
𝑍መ2 eksenleri üst üste çakışsın.
Z3

X3
d3
Y3

Z2
Y2 l
2

Z1
X2
2
d2
X1

Y1

Z0
h1

z0,1
X0 1

Y
24 0
b) 1. 𝛂𝐢−𝟏 : Şekildeki 𝑍መ0 ile 𝑍መ1 eksenlerinin dönme yönleri aynıdır.

i = 1 için  i −1 = 1−1 =  0 = 0  (0 ile 1 arası)

𝑍መ1 ile 𝑍መ2 eksenlerinin dönme yönleri arasında 90 derece vardır.

i = 2 için  i −1 =  2−1 = 1 = 90  (1 ile 2 arası)

𝑍መ2 ile 𝑍መ3 eksenlerinin dönme yönleri arasında -90 derece vardır.
i = 3 için  i −1 =  3−1 =  2 = −90  (2 ile 3 arası)

2. 𝐚𝐢−𝟏 : 0 ile 1. eklemler üst üste olduğundan bu iki eklem arasında yani 𝑍መ0 ile 𝑍መ1
arasında 𝑋෠0 boyunca herhangi bir bağ uzunluğu yoktur.

i = 1 için ai −1 = a1−1 = a0 = 0 ( Zˆ 0 ile Zˆ1 arası)

𝑍መ1 ile 𝑍መ2 arasında 𝑋෠1 boyunca herhangi bir uzunluk yoktur.

i = 2 için ai −1 = a2−1 = a1 = 0 ( Zˆ1 ile Zˆ 2 arası)

𝑍መ2 ile 𝑍መ3 arasında 𝑋෠2 boyunca herhangi bir uzunluk yoktur. 25

i = 3 için a = a = a = 0
i −1 3−1 2 (Zˆ ile Zˆ arası)
2 3
3. 𝐝𝐢 : 𝑋෠0 ile 𝑋෠1 arasında boyunca h1 uzunluğu vardır.

i = 1 için d i = d1 = h1 ( Xˆ 0 ile Xˆ 1 arası)

𝑋෠1 ile 𝑋෠2 arasında boyunca 𝑑2 uzunluğu vardır.


i = 2 için d i = d 2 ( Xˆ 1 ile Xˆ 2 arası)

𝑋෠2 ile 𝑋෠3 arasında 𝐼2 + 𝑑3 boyunca uzunluğu vardır.

i = 3 için d i = l 2 + d 3 ( Xˆ 2 ile Xˆ 3 arası)

4. 𝛉𝐢 veya 𝒅𝐢 :
İlk iki eklem dönel olduğundan,

i = 1 için i = 1 ve i = 2 için i =  2

son eklem prizmatik olduğundan i=3 için 𝑑İ = 𝑑3 ’tür.

26
DH Tablosu

c) Her bir eklem için dönüşüm matrisini yazalım. 1. Eklem için (i=1),
 c1 − s1 0 0  c1 − s1 0 0
 s c(0) c c(0) − s (0) 0   s c1 0 0 
1T =
0  1 1 = 1
 s1s (0) c1s (0) c(0) h1   0 0 1 h1 
   
 0 0 0 1  0 0 0 1

 c 2 − s 2 0 0  c 2 − s 2 0 0 
 s c(90) c c(90) − s(90) − s(90)d   0 0 −1 −d 2 
1
T =  2 2 2
=
2
 s 2 s(90) c 2 s(90) c(90) c(90)d 2   s 2 c 2 0 0 
   
 0 0 0 1   0 0 0 1 

 c(0) − s(0) 0 0  1 0 0 0 
 s(0)c(−90) c(0)c(−90) − s(−90) − s(−90)(l + d )  0 0 1 (l2 + d3 ) 
3T =
2  2 3 
=
 s(0) s(−90) c(0) s(−90) c(−90) c(−90)(l2 + d3 )  0 −1 0 0 
    27
 0 0 0 1  0 0 0 1 
d) Elde edilen üç dönüşüm matrisinin çarpılmasıyla ana çerçeveden araç
çerçeveye doğru 03𝑇 ileri yönlü robot kinematiği aşağıdaki gibi çıkarılır.

c1 − s1 0 0  c 2 − s 2 0 0  1 0 0 0 


 s c1 0 0   0 0 −1 −d 2  0 0 1 (l2 + d3 ) 
0
T = 0 1 2
T T T =  1

0 1 h1   s 2 c 2 0  0 −1 0 
3 1 2 3
0 0 0
   
0 0 0 1 0 0 0 1  0 0 0 1 

c1c 2 − s 1 − c1 s 2 − (l 2 + d 3 )(c1 s 2 ) + d 2 s1 


 s c c1 − s 1 s 2 − (l 2 + d 3 )( s1 s 2 ) − d 2 c1 
= 1 2
 s 2 0 c 2 (l 2 + d 3 )c 2 + h1 
 
 0 0 0 1 

28
e) Elde edilen 03𝑇 ileri kinematik denklemin doğru olup olmadığını tespit etmek
için 03𝑇 dönüşüm matrisinde konum vektörünü yazalım.

 p x  − (l 2 + d 3 )(c1 s 2 ) + d 2 s1 
 p  = − (l + d )( s s ) − d c 
 y  2 3 1 2 2 1

 p z   (l 2 + d 3 )c 2 + h1 
Bu vektörde bütün açılara 0 derece vererek robotun sıfır konumunu elde edelim.

 p x  − (l 2 + d 3 )c(0) s (0) + d 2 s (0)  px   0 


 p  = − (l + d ) s (0) s (0) − d c(0)  p  =  −d 
 y  2 3 2    y 2 
 p z   (l 2 + d 3 )c(0) + h1   p z  l 2 + d 3 + h1 

Denklemde görüldüğü gibi bu robot sıfır konumundayken 𝑝𝑥 ekseninde herhangi


bir uzunluğa sahip olmazken 𝑝𝑦 ekseninde −𝑑2 ve 𝑝𝑧 ekseninde ise 𝐼2 + 𝑑3 + ℎ1
uzunluğuna sahiptir.

29
Şekilde görüldüğü gibi 𝑝𝑦 eksenindeki 𝑑2 uzunluğunun −𝑑2 alınması sıfır
numaralı eksene yerleştirilen koordinat sisteminin y ekseniyle, robotun y
eksenindeki 𝑑2 uzunluğunun ters yönde olmasından kaynaklanmaktadır. Şekilde
𝑋0 , 𝑌0 , 𝑍0 eksenlerinde robotun bağ uzunluklarını tespit edelim. 𝑋0 ekseninde
robotun herhangi bir uzunluğu bulunmamaktadır. 𝑌0 ekseninde −𝑑2 ve 𝑍0
ekseninde ise 𝐼2 +𝑑3 +ℎ1 uzunlukları bulunmaktadır.

Konum vektörüne 0 derece vererek robotun


sıfır konumunda elde edilen denklemle sıfır
numaralı koordinat sistemine göre elde edilen
uzunluklar aynı çıktığından bu robotun ileri yön
kinematiği doğrudur. Eğer bu iki sonuç bir
birbirini tutmasaydı, özellikle koordinat
sistemlerinin yerleştirilmesinden itibaren bütün
adımların ve matris çarpımlarının kontrol
edilmesi gerekecekti.

30

You might also like