Professional Documents
Culture Documents
KOCAELİ ÜNİVERSİTESİ
MÜHENDİSLİK FAKÜLTESİ
MEKATRONİK MÜHENDİSLİĞİ
ÖRNEK 2.8
Örnek 2.3’de gerçekleştirilen 𝐵𝐴𝑅 işlemini dönüşüm matrislerinin ileri yönlü
çarpılması yöntemini kullanarak elde ediniz.
30
YB
ZB
60
ZA
30
YA
XB
XA 2
ÇÖZÜM 2.8
𝐴
𝐵𝑅 matrisini elde etmek {B} koordinat sisteminde bulunan X eksenini -30 derece
döndürüp, 𝑌𝐵 ′ eksenini +90 derece döndürerek {A} koordinat sisteminin yönelimi
ile {B} koordinat sisteminin yönelimlerini aynı yapalım. Gerçekleştirilen dönme
işlemlerinden ilki (RX(-30)) çarpma işleminde sona, ikincisini de (RY(90)) başa
yazılır. Burada yapılan işlem, {B} koordinat sistemini döndürülerek {A} koordinat
sistemini elde etmekten ibarettir.
c90 0 s90 1 0 0
A
B R RY 90R X 30 0 1 0 0 c 30 s 30
s90 0 c90 0 s 30 c 30
30
YB
30 YB 30 YB ZB
ZB YB ZB 90
60 60 60
ZA ZA ZB ZA XB
30
30
YA YA YA
XB XB XB
XA XA XA 3
2.6. Dönüşüm Matrislerinin Önden Çarpılması
Bir dönüşüm matrisini başka dönüşüm matrisi ile önden çarpmak öteleme/dönme
işleminin sabit referans koordinat sistemine göre gerçekleştirmektir
ÖRNEK 2.9
Örnek 2.8’deki 𝐵𝐴𝑅 matrisini önden çarpma yöntemini kullanarak bulunuz.
ÇÖZÜM 2.9
𝑍𝐴 30 derece döndürüp 𝑋𝐴 ′ ve 𝑌𝐴 ′ eksenlerini elde edilir. Yeni oluşan 𝑌𝐴 ′ eksenini
+90 derece döndürerek {A} ve {B} koordinat sisteminin yönelimlerin aynı yapılır.
Gerçekleştirilen dönme işlemleri aynı sıra ile yazılır. Burada yapılan işlem, {A}
koordinat sistemini döndürülerek {B} koordinat sistemi elde etmekten ibarettir.
A
B R RZ 30 RY 90
c30 s30 0 c90 0 s90 0.866 0.5 0 0 0 1 0 0.5 0.866
s30 c30 0 0 1 0 0.5 0.866 0 0 1 0 0 0.866 0.5
0 0 1 s90 0 c90 0 0 1 1 0 0 1 0 0
30
30 YB
YB
ZB
ZB 60
60
ZA
YA Z A
90 ZA XB
XA XB
YA
YA 4
XA XA
2.7. Dönüşüm Matrisinin Özellikleri
Uç işlevci herhangi bir hedefe yöneldiği zaman bu yönelim uç işlevcisinin normal
vektörü n = 𝑛𝑥 𝑛𝑦 𝑛𝑧 𝑇 , kayma vektörü s = 𝑠𝑥 𝑠𝑦 𝑠𝑧 𝑇 ve yaklaşım vektörü
a = a𝑥 a𝑦 a𝑧 𝑇 olmak üzere üç vektörle ifade edilir.
5
𝐴
𝐵𝑇 matrisinin tersini 𝐵𝐴𝑇 −1 şeklinde gösterelim.
𝐵 𝐵
𝐴 −1 𝐵 𝐴𝑅 𝑃𝐴𝑂𝑅𝐺
𝐵𝑇 = 𝐴𝑇 =
000 1
𝐴 −1 𝐵
𝐵
𝐴𝑅
𝐵
𝑃𝐴𝑂𝑅𝐺 = 𝐵𝐴𝑅 𝑇 − 𝐵𝐴𝑅 𝑇 𝐵𝑃𝐴𝑂𝑅𝐺
𝐵𝑇 = 𝐴𝑇 =
000 1 000 1
6
ÖRNEK 2.10
0.978 0 0.207 3
𝐴 0 1 0 −2 matrisinin tersini bulunuz.
𝐵𝑇 = −0.207 0 0.978 1
0 0 0 1
ÇÖZÜM 2.10
𝐴 𝑇
𝐴 −1 𝐵𝑅 − 𝐵𝐴𝑅 𝑇 𝐴𝑃𝐵𝑂𝑅𝐺
𝐵𝑇 =
000 1
𝐴 𝑇
İfadesinde sırasıyla 𝐵𝑅 dönme matrisini ve − 𝐵𝐴𝑅 𝑇 𝐴𝑃𝐵𝑂𝑅𝐺 konum vektörü
ifadelerini bulalım.
7
Konum vektörü ise ;
olur. Elde edilen dönme matrisi ve konum vektörünü ana denklemde yerine
yazmakla ter alma işlemi tamamlanmış olur.
8
2.8. Ardışık Dönüşümler
İkiden fazla koordinat sistemini içeren sistemlerde, koordinat sistemlerinin bir
birlerine göre konum ve yönelimleri ardışık koordinat sistemleri kullanılarak
gerçekleştirilir. {C} koordinat sistemine göre tanımlanan P noktasının konumunu ve
yönelimini {A} koordinat sistemine göre ardışık dönüşüm matrislerini kullanarak
tanımlayalım.
9
P noktasının sırayla {C} , {B} ve {A} koordinat sistemlerine göre konumları
bilinmekte ve bu konumlar birbirleri cinsinden dönüşüm matrisleri yardımıyla
ifade edilebilmektedir.
𝐵
𝑃 = 𝐵𝐶 𝑇 𝐶 𝑃, 𝐴
𝑃 = 𝐵𝐴𝑇 𝐵𝑃 𝐴
𝐶𝑇 = 𝐵𝐴𝑇 𝐵
𝐶𝑇
𝐴 𝐴 𝐵 𝐵
𝐴 𝐴 𝐵 𝐵𝑅 𝑃𝐵𝑂𝑅𝐺 𝐶𝑅 𝑃𝐶𝑂𝑅𝐺
𝐶𝑇 = 𝐵𝑇 𝐶 𝑇 =
000 1 000 1
𝐴 𝐵 𝐴 𝐵
= 𝐵𝑅 𝐶 𝑅 𝐵𝑅 𝑃𝐶𝑂𝑅𝐺 + 𝐴𝑃𝐵𝑂𝑅𝐺
000 1
Birden fazla koordinat sisteminin merkezleri arasına birer vektör çizilerek konum
ve yönelimleri birbirine göre tanımlanabilmektedir.
10
ÖRNEK 2.11
ÇÖZÜM 2.11
𝑈
𝐷𝑇 dönüşüm matrisini diğer koordinat sistemleri cinsinden iki farklı şekilde
tanımlayarak 𝐵𝐶 𝑇 matrisini bulalım.
11
{U} , {A} ve {D} koordinat sistemleri arasında aşağıdaki ilişkiyi kurabiliriz.
𝑈
𝐷𝑇 = 𝑈𝐴𝑇 𝐷𝐴𝑇 −1 = 𝑈𝐴𝑇 𝐷𝐴𝑇
{U} , {B} , {C} ve {D} koordinat sistemleri arasında aşağıdaki ilişkiyi kurabiliriz.
𝑈
𝐷𝑇 = 𝑈𝐵𝑇 𝐵𝐶 𝑇 𝐷𝐶 𝑇 −1 = 𝑈𝐵𝑇 𝐵𝐶 𝑇 𝐷𝐶𝑇
𝐵
𝐶𝑇 dönüşüm matrisini, yukarıdaki denklemleri birbirine eşitleyerek diğer
koordinat sistemleri cinsinden aşağıdaki gibi bulabiliriz.
𝑈 𝐵 𝐷 −1
𝐵𝑇 𝐶 𝑇 𝐶 𝑇 = 𝑈𝐴𝑇 𝐷𝐴𝑇 −1
𝑈 −1 𝑈 𝐵 𝐷 −1
𝐵𝑇 𝐵𝑇 𝐶 𝑇 𝐶 𝑇 = 𝑈𝐵𝑇 −1 𝑈𝐴𝑇 𝐷𝐴𝑇 −1
𝐵 𝐷 −1
𝐶𝑇 𝐶𝑇 = 𝑈𝐵𝑇 −1 𝑈𝐴𝑇 𝐷𝐴𝑇 −1 12
Denklemin her iki tarafını 𝐷𝐶 𝑇 ile çarpalım.
𝐵 𝐷 −1 𝐷
𝐶𝑇 𝐶𝑇 𝐶𝑇 = 𝑈𝐵𝑇 −1 𝑈𝐴𝑇 𝐷𝐴𝑇 −1 𝐷𝐶 𝑇
𝐵
𝐶𝑇 = 𝑈𝐵𝑇 −1 𝑈𝐴𝑇 𝐷𝐴𝑇 −1 𝐷𝐶 𝑇
ÖRNEK 2.12
Şekildeki 𝐺𝑇𝑇 dönüşüm matrisini diğer koordinatlar cinsinden tanımlayınız.
13
ÇÖZÜM 2.12
{B} , {W} ve {T} arasındaki ilişki {B} ve {S} arasındaki ilişkiye eşittir.
𝐵 𝑊 𝑇
𝑊𝑇 𝑇𝑇 𝐺 𝑇 = 𝐵𝑆𝑇 𝐺𝑆𝑇
𝐵 𝑇
𝑇𝑇 𝐺 𝑇 = 𝐵𝑆𝑇 𝐺𝑆𝑇
Denklemin her iki tarafı 𝐵𝑇𝑇 −1 ile çarpıldığında 𝐺𝑇𝑇 matrisi aşağıdaki gibi elde edilir.
𝑇
𝐺𝑇 = 𝐵𝑇𝑇 −1 𝐵𝑆𝑇 𝐺𝑆𝑇
14
2.9. Özel Yönelim Tanımlamaları
Koordinat sistemlerinin bir birlerine göre yönelimini 3x3 boyutlu dönme
matrisleriyle tanımlamak kinematik çözümler için uygun olmasına rağmen, dokuz
elemanı bulunan bu dönme matrislerini kullanarak başka bir cisme göre yönelim
tanımlamak hiçte kolay değildir. Bunun için genellikle dönme matrisinin üç
elemanı kullanılarak yönelim tanımlanır. Koordinat sistemleri arasında yönelim
tanımlamak için roll-pitch-yaw, Euler ve eşdeğer açı-eksen seti olmak üzere üç
farklı yöntem kullanılır. Şimdi sırayla koordinat sistemleri arasında yönelim
tanımlamak için kullanılan bu üç yöntemi geniş bir şekilde inceleyelim.
Eğer insanın eli avuç içi aşağı bakmak üzere ileri yönde yere paralel tutulursa, ‘roll’
elin kendi ekseni etrafında döndürülmesini, ‘pitch’ elin aşağı-yukarı hareket
ettirilmesi, yaw ise elin sağa sola hareket ettirilmesidir.
15
Z
Yaw Roll
X
Pitch
Robotun uç islevci
Sabit açı sistemine göre, iki koordinat sistemi arasında dönme işlemi
gerçekleştirmek için 12 farklı sabit açı kümesi kullanılır. {B} koordinat
sisteminin {A} koordinat sistemine göre dönme işlemi X-Y-Z sabit açı sistemine
göre aşağıdaki gibi bulunur.
16
İlk önce merkezleri çakışık olan {B} koordinat sistemi Şekilde görüldüğü gibi 𝑥𝐴
ekseni boyunca γ, 𝑦𝐴 ekseni boyunca β ve 𝑧𝐴 ekseni boyunca α açısıyla
döndürülür. 𝑥𝐴 , 𝑦𝐴 ve 𝑧𝐴 eksenleri boyunca gerçekleştirilen dönme işlemleri, sabit
{A} koordinat sistemine göre ifade edilir.
ZA ZA
YB YB
ZB
ZB
YA YA
XA
XA
17
XB XB
2.9.1.1. Roll-Pitch-Yaw (XYZ Sabit) Açı Setinin Ters Çözümü
𝑟11 𝑟12 𝑟13 𝑐α𝑐β 𝑐α𝑠β𝑠γ − 𝑠α𝑐γ 𝑐α𝑠β𝑐γ + 𝑠α𝑠γ
𝐴
𝐵𝑅𝑋𝑌𝑍 𝛾, 𝛽, 𝛼 = 𝑟21 𝑟22 𝑟23 = 𝑠α𝑐β 𝑠α𝑠β𝑠γ − 𝑐α𝑐γ 𝑠α𝑠β𝑐γ − 𝑐α𝑠γ
𝑟31 𝑟32 𝑟33 −𝑠β 𝑐β𝑠γ 𝑐β𝑐γ
𝑟11 2 + 𝑟21 2 = 𝑐 2 𝛼𝑐 2 𝛽 + 𝑠 2 𝛼𝑐 2 𝛽 = 𝑐 2 𝛼 + 𝑠 2 𝛼 𝑐 2 𝛽 = 𝑐 2 𝛽
𝑐𝛽 = ± 𝑟11 2 +𝑟21 2
𝑠𝛽 −𝑟31
= 𝛽 = Atan2(-𝑟31 , 𝑟11 2 +𝑟21 2 )
𝑐𝛽 𝑟11 2 +𝑟21 2
18
𝑟11 ve 𝑟21 matris elemanlarından yararlanılarak α açısı 𝛽 ≠ ±90° olmak koşuluyla
aşağıdaki gibi bulunur.
Sα = 𝑟21 ∕cβ ve cα = 𝑟11 ∕cβ α = Atan2(𝑟21 ∕cβ , 𝑟11 ∕cβ)
Şimdiye kadar yapılan çözümler 𝛽 ≠ ±90° koşulu için geçerliydi, bundan sonra ise
birde 𝛽 = ±90° koşuluna bakalım.
19
0 𝑐α𝑠γ − 𝑠α𝑐γ 𝑐α𝑐γ + 𝑠α𝑠γ 0 sin(γ − α) cos(γ − α)
= 0 𝑠α𝑠γ + 𝑐α𝑐γ 𝑠α𝑐γ − 𝑐α𝑠γ = 0 𝑐𝑜𝑠(γ − α) −sin(γ − α)
−1 0 0 −1 0 0
20
0 −𝑐α𝑠γ − 𝑠α𝑐γ −𝑐α𝑐γ + 𝑠α𝑠γ 0 −sin(γ + α) −cos(γ + α)
= 0 −𝑠α𝑠γ + 𝑐α𝑐γ −𝑠α𝑐γ − 𝑐α𝑠γ = 0 𝑐𝑜𝑠(γ + α) −sin(γ + α)
1 0 0 1 0 0
Bu denklemde de aynı şekilde γ 𝑣𝑒𝑦𝑎 α açısından birini 0 kabul ederek diğer açı
bulunur.
21
ÖRNEK 2.13
Bir robotun uç işlevcisine şekilde görüldüğü gibi sabit bir koordinat sistemi
yerleştiriliyor Uç işlevcisi sabit koordinat sisteminin eksenleri olan X boyunca 𝛾, Y
boyunca 𝛽, Z boyunca 𝛼 açısıyla döndürülerek aşağıdaki matris elde ediliyor. Elde
edilen matristen faydalanarak 𝛾 , 𝛽 𝑣𝑒 𝛼 açılarını bulunuz
ÇÖZÜM 2.13
0.47212 0.85165
=Atan2( 𝑐(−13.154) , 𝑐(−13.154)) = 29°
0.94508 0.23457
= Atan2( 𝑐(−13.154) , 𝑐(−13.154)) = 76.06°
23
ÖRNEK 2.14
Bir robotun uç işlevcisi sabit koordinat sisteminin X ekseninde γ=42 derece, Y
ekseninde β=-17 derece ve Z ekseninde α=25 derece döndürülüyor. Sonuçta
oluşan dönme matrisini bulunuz
ÇÖZÜM 2.14
X B
X B
X B
X B 25
𝐴
𝐵 𝑅𝑍 ′ 𝑌 ′ 𝑋 ′ 𝛼, 𝛽, 𝛾 = 𝑅𝑍 (𝛼)𝑅𝑌 (𝛽)𝑅𝑋 (𝛾)
𝑐α −𝑠α 0 𝑐β 0 𝑠β 1 0 0
= 𝑠α 𝑐α 0 0 1 0 0 𝑐γ −𝑠γ
0 0 1 −𝑠β 0 𝑐β 0 𝑠γ 𝑐γ
ÖRNEK 2.15
Bir robotun uç işlevcisine hareketli bir koordinat sistemi yerleştiriliyor. Öncelikle
bu hareketli koordinat sistemi Z ekseni boyunca α açısıyla döndürülüyor. Dönme
sonucu oluşan yeni koordinat sistemi Y ekseni boyunca β açısıyla döndürülüyor.
Son olarak, dönme sonucu oluşan yeni koordinat sistemi tekrar Z ekseni boyunca γ
açısıyla döndürülerek aşağıdaki dönme matrisi elde ediliyor. Bu matristen
faydalanarak α , β ve γ açılarını bulunuz.
Daha öncede belirtildiği gibi Euler açı setinde de iki koordinat sisetmi arasında
dönme işlemi on iki farklı şekilde gerçekleştirilebilir. Örnekte Z’Y’Z’ Euler açı
setinden faydalanarak dönme işlemi gerçekleştirilmiştir. Öncelikle Z’Y’Z' koordinat
sistemine göre ifade edilen dönme matrisini elde edelim.
A
B RZ 'Y 'Z ' , , RZ RY RZ
c s 0 c 0 s c s 0
s c 0 0 1 0 s c 0
0 0 1 s 0 c 0 0 1
27
Verilen matrisi sembolik dönme matrisiyle eşitlenir ve𝛽 sıfırdan farklı olmak
koşulu ile (𝛽≠0 ) bilinen yöntemler kullanarak γ, β ve α açıları bulunur.
A tan 2 (0.25) 2 (0.43301) 2 , 0.86603 29.999 30
YA YA
XB
YB 29
XA XA
Yukarıdaki denklemde vers𝜃 = (1 − c𝜃) yani v𝜃 = (1 − c𝜃) düzenlemesini yapalım :
𝑘𝑥 𝑘𝑥 v𝜃 + 𝑐𝜃 𝑘𝑦 𝑘𝑥 v𝜃 − 𝑘𝑧 𝑠𝜃 𝑘𝑧 𝑘𝑥 v𝜃 + 𝑘𝑦 𝑠𝜃 0
𝜃 = 𝑘𝑥 𝑘𝑦 v𝜃 + 𝑘𝑧 𝑠𝜃 𝑘𝑦 𝑘𝑦 v𝜃 + 𝑐𝜃 𝑘𝑧 𝑘𝑦 v𝜃 − 𝑘𝑥 𝑠𝜃 0
R 𝐾,
𝑘𝑥 𝑘𝑧 v𝜃 − 𝑘𝑦 𝑠𝜃 𝑘𝑦 𝑘𝑧 v𝜃 + 𝑘𝑥 𝑠𝜃 𝑘𝑧 𝑘𝑧 v𝜃 + 𝑐𝜃 0
0 0 0 1
30
vektörü ve 𝜃 şöyle elde edilir :
Bir takım işlemler sonucu 𝐾
𝑟32 𝑟23
1
=
𝐾 𝑟13 𝑟31
2𝑠𝜃
𝑟21 𝑟12
𝜃 = Atan2( (𝑟32 −𝑟23 )2 + (𝑟13 − 𝑟31 )2 +(𝑟21 − 𝑟12 )2 ,𝑟11 + 𝑟22 + 𝑟33 − 1)
ÖRNEK 2.16
{A} koordinat sistemine bir 𝐴𝐾 = 0.18121 −0.43749 0.88078 vektörü
yerleştirilip, bu vektör 𝜃 = 92.2934° döndürülerek {B} koordinat sistemi elde
ediliyor. Bu iki koordinat sistemi arasındaki dönmeyi temsil eden 𝑅𝐾 𝜃 matrisini
bulunuz.
31
ÇÖZÜM 2.16
𝑘𝑥 𝑘𝑥 1 − 𝑐𝜃 + 𝑐𝜃 𝑘𝑦 𝑘𝑥 1 − 𝑐𝜃 − 𝑘𝑧 𝑠𝜃 𝑘𝑧 𝑘𝑥 1 − 𝑐𝜃 + 𝑘𝑦 𝑠𝜃 0
𝜃 = 𝑘𝑥 𝑘𝑦 1 − 𝑐𝜃 + 𝑘𝑧 𝑠𝜃 𝑘𝑦 𝑘𝑦 1 − 𝑐𝜃 + 𝑐𝜃 𝑘𝑧 𝑘𝑦 1 − 𝑐𝜃 − 𝑘𝑥 𝑠𝜃 0
R 𝐾,
𝑘𝑥 𝑘𝑧 1 − 𝑐𝜃 − 𝑘𝑦 𝑠𝜃 𝑘𝑦 𝑘𝑧 1 − 𝑐𝜃 + 𝑘𝑥 𝑠𝜃 𝑘𝑧 𝑘𝑧 1 − 𝑐𝜃 + 𝑐𝜃 0
0 0 0 1
32
ÖRNEK 2.17
{A} koordinat sistemine bir 𝐴𝐾 vektörü yerleştirip θ açısıyla döndürülerek {B}
koordinat sistemi elde ediliyor. Bu iki koordinat sistemi arasındaki dönmeyi temsil
eden 𝑅𝐾 𝜃 matrisi aşağıda verildiğine göre 𝐴𝐾 vektörünün elemanlarını ve θ
açısını bulunuz.
- 0.43561 - 0.68255 - 0.58682 0
0.86116 - 0.12625 - 0.4924 0
R Kˆ ,
0.262 - 0.71985 0.64279 0
0 0 0 1
ÇÖZÜM 2.17
Öncelikle Atan2 fonksiyonunu kullanarak θ açısı bulalım.
A tan 2( (r32 r23 ) 2 (r13 r31 ) 2 (r21 r12 ) 2 , r11 r22 r33 1)
33
r32 r23 0.71985 0.4924 0.22745
r13 r31 0.58682 0.262 0.84882
r21 r12 0.86116 0.68255 1.54371
r11 r22 r33 1 0.91907
0.031882
r22
r32
- 0.6346
r33 0
0 0 0 1
ÇÖZÜM 2.18
𝑅𝐾 𝜃 matrisinin özelliklerinden faydalanarak bilinmeyen elemanları bulalım.
r11r11 r12 r12 r13 r13 1 (-0.68402) 2 (-0.31665) 2 r132 1 r13 0.65715
35
Bulduğumuz 𝑟13 ve 𝑟21 ifadelerini 𝑅𝐾 𝜃 matrisinde yerine koyalım.
r21r21 r22 r22 r23 r23 1 (0.72874) 2 r222 (-0.6346) 2 1 r22 0.25286
Bulduğumuz 𝑟22 ifadesini 𝑅𝐾 𝜃 matrisinde yerine koyalım.
r12 r12 r22 r22 r32 r32 1 (-0.31665) 2 (0.25286) 2 r322 1 r32 0.9142236
Son olarak 𝑅𝐾 𝜃 matrisindeki 𝑟13 𝑟13 + 𝑟23 𝑟23 + 𝑟33 𝑟33 = 1 özelliğinden
faydalanarak 𝑟33 elemanını bulalım.
r13 r13 r23 r23 r33 r33 1
Elde edilen dönüşüm matrisi elemanlarının sadece pozitif değerleri göz önünde
bulundurulursa 𝑅𝐾 𝜃 matrisi aşağıdaki gibi elde edilir.
38
Ẑ
v1
BA R A
PBORG {B}
BT
A
0 0 0 1
Ŷ
{A}
X̂
{B} koordinat sistemine göre tanımlanan v1 hız vektörünü {A} koordinat sistemine
göre tanımlamak için aşağıdaki denklemden faydalanılır.
V BAR BV
A
İki koordinat sistemi arasında hız tanımlanırken konum ifadesi yer aldığından
aşağıdaki denklem kesinlikle kullanılamaz.
V ABT BV
A
39
ÖRNEK 2.19
{A} ve {B} koordinat sistemleri arasındaki dönüşüm matrisi, BV ve BP vektörleri
sırasıyla aşağıdaki gibi veriliyor. Buna göre AV vektörünü bulunuz.
0.866 - 0.5 0 11
0.5 0.866 0 3 5
BT
A B
V 8
0 0 1 9
10
0 0 0 1
ÇÖZÜM 2.19
40