5 EKSENLİ ROBOT KOLUNUN YÖRÜNGE PLANLAMASI ve DENEYSEL UYGULAMA

... konulu sunumlar: "5 EKSENLİ ROBOT KOLUNUN YÖRÜNGE PLANLAMASI ve DENEYSEL UYGULAMA"— Sunum transkripti:

1 5 EKSENLİ ROBOT KOLUNUN YÖRÜNGE PLANLAMASI ve DENEYSEL UYGULAMA
Kenan KILIÇASLAN Yöneten: Yrd.Doç.Dr. Hilmi KUŞÇU

2 LabVIEW LabVIEW ile programlama mantığı, program kodu yazılan programlama mantığına benzemekle birlikte, kontrol adı verilen nesneler arasında veri yolu bağlantısı ile program akışı sağlanır. Kontroller içindeki veri elektrik kablosuna benzer çizgi üzerinden bağlı olduğu kontrole geçer.

3 LabVIEW Labview’de içinde veri bulunan üç çeşit nesne bulunur.
Control : Kullanıcının program çalışırken veri girdiği nesnelerdir. Çeşitli şekilleri bulunur. Indicator : Kullanıcı program çalışırken veri giremez, hesaplama sonucu bulunur. Çeşitli şekilleri vardır. Constant : Sabit değerdir. Program çalışırken değiştirilemez.

4 LabVIEW Control ve indicator birbirine benzerdir.
Control isimli nesnelerde bulunan veri veri yolları üzerinden indicator isimli nesneye veya matematiksel sembollere doğru akar.

5 LabVIEW Veri Yolları Elektrikte iki farklı fazın birbirine bağlanması hata meydana getirir, benzer şekilde farklı controllara bağlı veri yolu bir birine bağlanmamalıdır. Bir kontrole ve indikatöre sadece bir veri yolu bağlanabilir. Elektrikte bir kablonun ortasına başka bir kablo bağlasak bu kabloda aynı voltta elektrik olur, aynı şekilde bir veri yolu kablosunun herhangi bir yerine başka bir veri yolu kablosu bağlasak, bu kabloda da aynı veri bulunur.

6

7 Labview LabVIEW’de iki pencere vardır.
Görsel nesnelerin bulunduğu Front Panel, program akışının bulunduğu Block Diagram penceresi. Programlama block diagram penceresinden yapılır.

8

9 LabVIEW ile Diğer Programların Karşılaştırması
Normal programlama mantığında, bir başlangıç vardır ve bir de sonu vardır yani bir yerde program akışı durur. LabVIEW’de ise program akışı, en uzaktaki indicatöre gittiğinde yine başa döner yani tüm akış bir sonsuz döngü içindedir. Döngü sonsuz olduğu için, control içindeki verinin işlem görmesi için bir olay tanımına ihtiyaç yoktur. Bir controle veri girildiğinde, o veri doğrudan kablo üzerinden akar ve kablonun bağlı olduğu yere gider.

10 LabVIEW ile Diğer Programların Karşılaştırması
Çok bilinen programlamada, programlar tek görevlidir. Yani bu programlar örneğin aynı anda iki sayıyı toplayamaz. Bu toplama işlemini sıralı olarak yaparlar. LabVIEW ise çok görevlidir yani aynı anda iki toplama işlemini yapar. Bütün işlemler paralel yürür. Her an veri yolu kablolarında veri vardır. LabVIEW’de paralel çalışan birden fazla döngü bulunabilir.

11 İleri Kinematik Şekildeki düzlemsel iki bağlantı mekanizmasını inceleyelim. Uç A noktasından B noktasına doğru sabit hızla ilerlesin.

12 İleri Kinematik Birinci problem, eklem açıları çiftinin verilmesi ile uç noktanın koordinatını bulmak. Yani açıdan faydalanarak koordinat bulma işlemi ileri kinematik olarak anılır.

13 Ters Kinematik İkinci problem, uç nokta koordinatı verilir eklem açıları istenir. Bu problem ters kinematik olarak anılır. Problemin aynı konumu veren birden fazla çözümü olabilir. Hem (q1,q2) hem de (-q1,-q2) aynı koordinatını verir.

14 Çalışmaya Konu Olan Robot Kol

15

16

17

18

19 Uygulamada Bilinenler
Uç nokta koordinatı bilinmektedir. Robot kolunun boyutları bilinmektedir.

20 Deneysel Uygulama İçin Yapılan Adımlar
Denavit-Hartenberg Metodu ile tüm eklemlerin dönüşüm matrisi çıkarıldı.

21 Dönüşüm Matrisleri Bulundu

22 Dönüşüm Matrisleri Çarpıldı.
Denklem bulunan, eklem açıları cinsindendir. Denklemde ise uç nokta koordinatı bellidir. Birinci denklem ile ikinci denklem eşittir.

23 Dönüşüm Matrisleri Çarpıldı.

24 Bir matrisin tersi ile matrisin çarpımı birim matrise eşittir.
Biz bu eşitlikten yararlandık.

25 Bize ters tüm dönüşüm matrislerini tersi gerekli oldu
Ters matrisi Matlab yazılımının inv fonksiyonunu kullandık TersMatris = inv (Matris)

26 Ters Matrisler

27 Birinci matris eşitliği
Konum Vektörlerini eşitledik. 3 denklemimiz oldu. Birinci tarafa A Diyelim Birinci tarafa B Diyelim

28 Birinci matris eşitliği
Konum Vektörlerini eşitledik. 3 denklemimiz oldu.

29 İkinci Matris eşitliği

30 İkinci matris eşitliği
Konum Vektörlerini eşitledik. 3 denklemimiz oldu.

31 Üçüncü Matris eşitliği

32 Üçüncü matris eşitliği
Konum Vektörlerini eşitledik. 3 denklemimiz oldu.

33 Dördüncü Matris eşitliği

34 Dördüncü matris eşitliği
Konum Vektörlerini eşitledik. 3 denklemimiz oldu.

35 Matlab ile örnek uygulama
(11,17,9) cm koordinatlarını veren açıları bulalım. Burada L=9.5 cm, h=7 cm’dir.

36

37

38

39 Çözümde Matlab’ın fsolve fonksiyonu kullanılmıştır
Çözümde Matlab’ın fsolve fonksiyonu kullanılmıştır. fsolve fonksiyonu sonucu iterasyonla bulur. İterasyon için başlangıç matrisi x0=[0 0 0] ‘dır. cos(x(3))+sin(x(2))* sin(x(3))-cos(x(2))-1; -sin(x(1))*A+cos(x(1))*B-sin(x(2))* cos(x(3))- cos(x(2))*sin(x(3))-sin(x(2));-cos(x(1))*sin(x(2))*A-sin(x(1))*cos(x(2))*A +cos(x(1))* cos(x(2))*B-sin(x(1))*sin(x(2))*B+sin(x(2))-sin(x(3))],x0);

40

41

42

43 Çalışmanın LabVIEW’de uygulaması, Yörünge Hesabı
Fonksiyon Adı Sembolü Açıklama T01.vi Yükseklik-h, Kol Uzunluğu-L ve açı değerlerinden dönüşüm matrisini oluşturur. Detaylı bilgi bölüm 4.1.1’dedir. ilerikinematik.vi Dönüşüm matrislerinden, başlangıçtan uca doğru dönüşüm matrislerini ve PX,PY ve PZ vektörlerini oluşturur. Detaylı bilgi bölüm 4.1.2’dedir. 3D Curve.vi PX, PY ve PZ vektörlerinden 3 boyutlu grafik oluşturur. terskinematik.vi X, Y, Z koordinatlarından, t2, t3, t4 açılarını ve bölüm 4.2.1’de belirtilen diğer değerleri hesaplar. terskinematik2.vi Bilinen açılara göre diğer açıları hesaplar. Ayrıntılı bilgi bölüm 4.2.2’dedir. terskinematik3.vi terskinematik.vi’ile hesaplanan açıları, kolun sınırları içine alır. Ayrıntılı bilgi bölüm 4.2.3’dedir.

44

45

46

47

48

49

50 Sorulanız… Teşekkürler…