ÖNGÖRÜLÜ KONTROL İLE ALTI EKLEMLİ BİR ROBOT KOLUNUN EKLEM ESASLI YÖRÜNGE KONTROLÜ



Benzer belgeler
G( q ) yer çekimi matrisi;

KİNETİK MODEL PARAMETRELERİNİN BELİRLENMESİNDE KULLANILAN OPTİMİZASYON TEKNİKLERİNİN KIYASLANMASI

5 serbestlik dereceli robot kolunun modellenmesi ve kontrolü. Modelling and control of 5 dof robotic arm

Ege Üniversitesi Elektrik Elektronik Mühendisliği Bölümü Kontrol Sistemleri II Dersi

İleri Diferansiyel Denklemler

MAK 308 MAKİNA DİNAMİĞİ Bahar Dr. Nurdan Bilgin

Electronic Letters on Science & Engineering 1(1) 2005 Available online at

5 SERBESTLİK DERECELİ ROBOT KOLUNUN KİNEMATİK HESAPLAMALARI VE PID İLE YÖRÜNGE KONTROLÜ

Mühendislik Mekaniği Dinamik. Yrd.Doç.Dr. Akın Ataş

2011 Third International Conference on Intelligent Human-Machine Systems and Cybernetics

Ege Üniversitesi Elektrik Elektronik Mühendisliği Bölümü Kontrol Sistemleri II Dersi

Mühendislik Mekaniği Statik. Yrd.Doç.Dr. Akın Ataş

BULANIK MANTIK KONTROLLÜ ÇİFT EKLEMLİ ROBOT KOLU. Göksu Görel 1, İsmail H. ALTAŞ 2

QUANTILE REGRESYON * Quantile Regression

RİJİT CİSİMLERİN DÜZLEMSEL KİNEMATİĞİ

DENEY.3 - DC MOTOR KONUM-HIZ KONTROLÜ

1. Giriş. 2. Dört Rotorlu Hava Aracı Dinamiği 3. Kontrolör Tasarımı 4. Deneyler ve Sonuçları. 5. Sonuç

Mühendislikte Sayısal Çözüm Yöntemleri NÜMERİK ANALİZ. Prof. Dr. İbrahim UZUN

OTOMATİK KONTROL SİSTEMLERİ. DİNAMİK SİSTEMLERİN MODELLENMESİ ve ANALİZİ

MAK 308 MAKİNA DİNAMİĞİ Bahar Dr. Nurdan Bilgin

RCRCR KAVRAMA MEKANİZMASININ KİNEMATİK ANALİZİ Koray KAVLAK

Sistem Dinamiği. Bölüm 3- Rijit Gövdeli Mekanik Sistemlerin Modellenmesi. Doç.Dr. Erhan AKDOĞAN

MAK 210 SAYISAL ANALİZ

Bölüm 2. Bir boyutta hareket

Okut. Yüksel YURTAY. İletişim : (264) Sayısal Analiz. Giriş.

İKİ BOYUTLU ÇUBUK SİSTEMLER İÇİN YAPI ANALİZ PROGRAM YAZMA SİSTEMATİĞİ

(Mekanik Sistemlerde PID Kontrol Uygulaması - 1) SÜSPANSİYON SİSTEMLERİNİN PID İLE KONTROLÜ. DENEY SORUMLUSU Arş.Gör. Sertaç SAVAŞ

Yapı Sistemlerinin Hesabı İçin. Matris Metotları. Prof.Dr. Engin ORAKDÖĞEN Doç.Dr. Ercan YÜKSEL Bahar Yarıyılı

ROBOTLARIN YAPAY SİNİR AĞLARI KULLANILARAK DENETİMİ.

EĞRİSEL YAPI ELEMANLARININ ETKİN SAYISAL ANALİZİ ÜZERİNE BİR ARAŞTIRMA 1. A Study on An EfficientNumerical Analysis of TheCurvedStructuralElements

PUMA TİPİ ROBOT İLE İNSAN KOLU HAREKETLERİNİN KARŞILAŞTIRILMASI; ALTERNATİF BİR ROBOT KOL OMUZ TASARIMI

KOÜ. Mühendislik Fakültesi Makine Mühendisliği ( 1. ve 2. Öğretim ) Bölümü Dinamik Dersi (Türkçe Dilinde) 2. Çalişma Soruları / 21 Ekim 2018

Yrd. Doç. Dr. Mustafa NİL

MAK 210 SAYISAL ANALİZ

Copyright The McGraw-Hill Companies, Inc. Permission required for reproduction or display. BÖLÜM 7. Adi Diferansiyel Denklemlerin Sayısal Çözümü

Bölüm 3. Tek Serbestlik Dereceli Sistemlerin Zorlanmamış Titreşimi

BÖLÜM 1: MADDESEL NOKTANIN KİNEMATİĞİ

BELĐRLĐ BĐR SIKMA KUVVETĐ ETKĐSĐNDE BĐSĐKLET FREN KOLU KUVVET ANALĐZĐNĐN YAPILMASI

2 1 fonksiyonu veriliyor. olacak şekilde ortalama değer teoremini sağlayacak bir c sayısının var olup olmadığını araştırınız. Eğer var ise bulunuz.

MAK585 Dinamik Sistemlerin Modellenmesi ve Simülasyonu

ROBOTİK EĞİTİMİ İÇİN GÖRSEL BİR ARA YÜZ

Fiziksel Sistemlerin Matematik Modeli. Prof. Neil A.Duffie University of Wisconsin-Madison ÇEVİRİ Doç. Dr. Hüseyin BULGURCU 2012

Trajectory Planning of a 5-DOF Serial Robot Manipulator in Joint-Space

DİNAMİK - 7. Yrd. Doç. Dr. Mehmet Ali Dayıoğlu Ankara Üniversitesi Ziraat Fakültesi. Tarım Makinaları ve Teknolojileri Mühendisliği Bölümü

Kesirli Türevde Son Gelişmeler

KATI CİSİMLERİN BAĞIL İVME ANALİZİ:

OTOMOBİLLER İÇİN BULANIK MANTIK TABANLI HIZ SABİTLEYİCİ BİR SİSTEM

Mühendislik Mekaniği Statik. Yrd.Doç.Dr. Akın Ataş

Otomatik Kontrol I. Dinamik Sistemlerin Matematik Modellenmesi. Yard.Doç.Dr. Vasfi Emre Ömürlü

OTOMATİK KONTROL SİSTEMLERİ İŞARET AKIŞ DİYAGRAMLARI SIGNAL FLOW GRAPH

Ortak Akıl MATEMATİK DENEME SINAVI

Sezai Taşkın Accepted: January ISSN : itemiz@marmara.edu.tr Istanbul-Turkey

T.C. TRAKYA ÜNİVERSİTESİ FEN BİLİMLERİ ENSTİTÜSÜ

Newton un ikinci yasası: Bir cisim ivmesi cisim üzerine etki eden toplam kuvvet ile doğru orantılı cismin kütlesi ile ters orantılıdır.

1. Hafta SAYISAL ANALİZE GİRİŞ

Akım Modlu Çarpıcı/Bölücü

Fizik 101: Ders 18 Ajanda

ROBOTİK - 2. K o n u k E d i t ö r : P r o f. D r. A y d ı n E R S A K ELEKTRİK MÜHENDİSLİĞİ

Diferensiyel denklemler sürekli sistemlerin hareketlerinin ifade edilmesinde kullanılan denklemlerdir.

Sakarya Üniversitesi - Bilgisayar Mühendisliği

Doç. Dr. Bilge DORAN

23. Sistem denge denklemlerinin direkt kurulması

Mesleki Terminoloji. Sayısal Analiz DERSİ VEREN: ARŞ. GRV. DR. GÖKSEL BİRİCİK MEHMET EMRE ÖNDER DOĞAÇ CEM İŞOĞLU

FEN FAKÜLTESİ MATEMATİK BÖLÜMÜ YAZ OKULU DERS İÇERİGİ. Bölümü Dersin Kodu ve Adı T P K AKTS

OTOMATİK KONTROL. Set noktası (Hedef) + Kontrol edici. Son kontrol elemanı PROSES. Dönüştürücü. Ölçüm elemanı

Kübik Spline lar/cubic Splines

Yapısal Analiz Programı SAP2000 Bilgi Aktarımı ve Kullanımı. Doç.Dr. Bilge Doran

STATİK MÜHENDİSLİK MEKANİĞİ. Behcet DAĞHAN. Behcet DAĞHAN. Behcet DAĞHAN. Behcet DAĞHAN

Yapı Sistemlerinin Hesabı İçin. Matris Metotları. Prof.Dr. Engin ORAKDÖĞEN Doç.Dr. Ercan YÜKSEL Bahar Yarıyılı

BÖLÜM 4: MADDESEL NOKTANIN KİNETİĞİ: İMPULS ve MOMENTUM

(Mekanik Sistemlerde PID Kontrol Uygulaması - 3) HAVA KÜTLE AKIŞ SİSTEMLERİNDE PID İLE SICAKLIK KONTROLÜ. DENEY SORUMLUSU Arş.Gör.

DİNAMİK Yrd. Doç. Dr. Mehmet Ali Dayıoğlu Ankara Üniversitesi Ziraat Fakültesi. Tarım Makinaları ve Teknolojileri Mühendisliği Bölümü

Robotların bugünkü konumu ve geliştirilmesi

Geriye Yayılım ve Levenberg Marquardt Algoritmalarının YSA Eğitimlerindeki Başarımlarının Dinamik Sistemler Üzerindeki Başarımı. Mehmet Ali Çavuşlu

DİNAMİK - 1. Yrd. Doç. Dr. Mehmet Ali Dayıoğlu Ankara Üniversitesi Ziraat Fakültesi Tarım Makinaları ve Teknolojileri Mühendisliği Bölümü

Şekil 1. DEÜ Test Asansörü kuyusu.

Tek Eklemli Esnek Bağlı Robot Kolunun Modellenmesi, Tasarımı ve Bulanık Mantık ile Kontrolü

ÖZGEÇMİŞ. 1. Adı Soyadı : Kamile ŞANLI KULA İletişim Bilgileri : Ahi Evran Üniversitesi, Fen Edebiyat Fakültesi, Adres Matematik Bölümü, KIRŞEHİR

Doğrusal Demet Işıksallığı 2. Fatma Çağla Öztürk

ADAPTİF FİLTRELERDE GAUSS-SEIDEL ALGORİTMASININ STOKASTİK YAKINSAMA ANALİZİ

RİJİT CİSMİN DÜZLEMSEL KİNETİĞİ: ENERJİNİN KORUNUMU

BMÜ-421 Benzetim ve Modelleme MATLAB SIMULINK. İlhan AYDIN

Gerçekte yükler yayılı olup, tekil yük problemlerin çözümünü kolaylaştıran bir idealleştirmedir.

HOMOGEN OLMAYAN DENKLEMLER

Hareket Kanunları Uygulamaları

1. DENEY ADI: Rezonans Deneyi. analitik olarak bulmak denir. Serbestlik Derecesi: Genlik: Periyot: Frekans: Harmonik Hareket:

1.1 Yapı Dinamiğine Giriş

STATİK. Ders_9. Doç.Dr. İbrahim Serkan MISIR DEÜ İnşaat Mühendisliği Bölümü. Ders notları için: GÜZ

BTÜ MAKİNE MÜHENDİSLİĞİ BÖLÜMÜ MAKİNE LABORATUVARI DERSİ

AKARSULARDA KİRLENME KONTROLÜ İÇİN BİR DİNAMİK BENZETİM YAZILIMI

MONTE CARLO BENZETİMİ

İleri Diferansiyel Denklemler

MEKATRONİK VE KONTROL LABORATUARI DENEY FÖYÜ

fonksiyonunun [-1,1] arasındaki grafiği hesaba katılırsa bulunan sonucun

r r r F İŞ : Şekil yörüngesinde hareket eden bir parçacık üzerine kuvvetini göstermektedir. Parçacık A noktasından

KİNETİK ENERJİ, İŞ-İŞ ve ENERJİ PRENSİBİ

SAYISAL ÇÖZÜMLEME. Yrd.Doç.Dr.Esra Tunç Görmüş. 1.Hafta

Şekilde görülen integralin hesaplanmasında, fonksiyonun her verilen bir noktası için kümülatif alan hesabı yapılır.

Elemanter fonksiyonlarla yaklaşım ve hata

SAYISAL ÇÖZÜMLEME Yrd. Doç. Dr. Adnan SONDAŞ Sayısal Çözümleme

Transkript:

ÖNGÖRÜLÜ KONTROL İLE ALTI EKLEMLİ BİR ROBOT KOLUNUN EKLEM ESASLI YÖRÜNGE KONTROLÜ Burhanettin DURMUŞ, Hasan TEMURTAŞ 2 Dumlupınar Üniversitesi, Mühendislik Fakültesi, Elektrik-Elektronik Mühendisliği Bölümü, Kütahya, bdurmus@dpu.edu.tr 2 Dumlupınar Üniversitesi, Mühendislik Fakültesi, Bilgisayar Mühendisliği Bölümü, Kütahya, temurtas@dpu.edu.tr Geliş Tarihi: 04.06.2008 Kabul Tarihi: 4.05..200 ÖZET Bu çalışmada altı eklemli bir robot kolunun eklem esaslı yörünge kontrolü için genelleştirilmiş öngörülü kontrolör (GPC tasarlanmıştır. Robot kolunun dinamik modellemesinde Lagrange-Euler yöntemi kullanılmış, yörünge planlaması sinüzoidal yörünge prensibine göre yapılmıştır. Tasarlanan kontrolör, istenilen yörünge boyunca robot kolu eklemlerini kontrol edecek uygun tork değerlerini üretmektedir. Öngörü modeli için CARIMA (Controlled Auto Regressive Integrated Moving Average doğrusal formu kullanılmış, parametre kestirim işlemi ise en küçük kareler yöntemi (Recursive Least Squares-RLS ile gerçeklenmiştir. Anahtar Kelimeler: Robot kontrolü, yörünge planlaması, öngörülü kontrol. BASED JOINT TRAJECTORY CONTROL OF 6-DOF ROBOT MANIPULATOR BY USING GENERALIZED PREDICTIVE CONTROL ABSTRACT In this study, generalized predictive controller (GPC was designed for based joint trajectorycontrol of 6- DOF(Degree-Of-Freedom robotic manipulator. Modeling of the dynamics of the robotic manipulator was made by using the Lagrange-Euler equations and the cubic trajectory principle was used for trajectory planning. Designed controller computes values of torque belonging to joints through motion. CARIMA(Controlled Auto- Regresive Integrated Moving Average model was used for prediciton model. The parameter estimation was carried out using the RLS(Recursive Least Squares. Keywords: Robotic control, trajectory planning, predictive contol.. GİRİŞ Günümüz otomasyon sistemlerinin vazgeçilmez elemanı olan robotlar; üretim, hizmet, güvenlik, sağlık gibi birçok alanda yaygın bir şekilde kullanılmaktadır. İnsan gücüne oranla daha ucuz olmaları, üretim hızını, kapasitesini ve verimliliğini arttırmaları robotları önemli kılmaktadırlar. Geniş bir uygulama alanı bulunan robotlar için yıllardır birçok kontrol metotları geliştirilmiş, dinamik modelleri oluşturulmuş, icra edeceği hareket ve görevleri için değişik yapıda ve ekleme sahip tasarımlar yapılmıştır. Bu tasarımların en yaygın olanları kol benzeri yapılarda olan robot kollarıdır. Robot kolları uzuvların birbirlerine eklemler aracılığı ile bağlandığı ve ilk eklemin sabitlendiği yapılardır. İcra edeceği göreve bağlı olarak uzuvların şekilleri değiştirilebilir ve uzuv sayıları arttırılabilir. Robot kolunda uzuv sayısını arttırmak kolun hareket manevrasını arttırmaktadır. Ancak eklemler arasında yüksek oranda etkileşimler mevcut olduğundan eklem sayısı arttırmak kolun kontrolünü güçleştirecektir. Dolayısıyla eklem sayısının optimum düzeyde tutulması istenir. Bu bağlamda altı serbestlik derecesi birçok uygulama için ideal görülmüştür []. Robot kolunun dinamik kontrolü, robot kolu eklemlerinin istenilen pozisyon ve hız referansları doğrultusunda hareketlerini sağlayacak giriş bilgilerini (tork / voltaj üreterek eklemlere vermek şeklindedir. Ancak, robot 23

kolunun dinamik davranışını veren denklemlerin ikinci dereceden doğrusal olmayan diferansiyel denklemler olmaları ve aralarında yüksek oranda etkileşimler bulunması robot kolunun kontrolünü zorlaştırmaktadır. Bu yüzden klasik kontrol sistemlerini kullanan endüstriyel robot kolları belirli bir hız limitinin üzerine kolayca çıkamamakta, sonuç olarak üretim verimliliği sınırlanmaktadır. Ayrıca, her geçen gün artan performans isteklerinden dolayı daha gelişmiş kontrol tekniklerine gereksinim duyulmaktadır. Kullanılan ticari robotların büyük çoğunluğu nispeten basit olan kontrol sistemleri ile donatılmışlardır. Bunlara örnek olarak PI (Proportional Integral ve PID ( Proportional + Integral + Differential tipi kontrolörler gösterilebilir [2-4]. Fakat bu tip kontrol sistemlerinin sadece düşük hızlarda yeterli olabildikleri yapılan çalışmalar ile kanıtlanmıştır []. Robot kolunun çalışma hızını artırabilmek için eklem hızları arttırıldığında etkileşimler ve robot kolu modelindeki belirsizlikler nedeniyle istenilen yörünge ile gerçekleşen yörünge arasında önemli hatalar ortaya çıkmaktadır. Bu nedenle klasik kontrol sistemlerini kullanan robot kolları, yeterli hassasiyeti yakalamak için düşük hızlarda çalıştırılmaktadır. Artan performans taleplerinden dolayı robot kolu kontrolü için daha gelişmiş kontrol algoritmalarına ihtiyaç duyulmaktadır. Bu algoritmalardan biride Genelleştirilmiş Öngörülü Kontrol (GPC algoritmasıdır. İlk olarak Clarke ve arkadaşları [5-9] tarafından geliştirilen ve kendinden önceki uzun menzilli öngörülü kontrol algoritmalarının bir sentezi niteliğini taşıyan Genelleştirilmiş Öngörülü Kontrol (Generalized Predictive Control - GPC algoritması bir gerileyen ufuklar metodudur [0]. Robot kontrolü gibi referans yörüngenin önceden programlandığı durumlar için oldukça kullanışlıdır []. Bu çalışmada, altı eklemli bir robot kolu için Genelleştirilmiş Öngörülü Kontrol (GPC algoritmasını kullanan bir kontrolör tasarlanmıştır. Kontrolör daha önceden belirlenen referans yörüngeleri takip etmesi için eklemlere uygulanacak uygun tork değerlerini üretmektedir. Üretilen bu tork değerleri robot koluna manipülatörüne uygulanır. Robot kolu dinamik modelinden alınan konum ve hız bilgilerini tekrardan kontrolöre iletilerek referans yörünge ile gerçeklenen yörünge arasındaki hatalar minimize edilecek şekilde hareket sonuna kadar kontrole devam edilir. Robot kolunun dinamik modellenmesinde Lagrange-Euler yöntemi kullanılmıştır. Modele sürtünme ve uç noktada taşınan yük etkisi de ayrıca ilave edilmiştir. Referans yörüngeler sinüzoidal yörünge prensibine göre hesaplanmıştır. Dinamik model 4. dereceden Runge-Kutta yöntemi ile robot kolu simülatörüne dönüştürülmüştür. Bu çalışmanın kalan kısmı şöyle organize edilmiştir: Bölüm 2 de kullanılan robot kolunun dinamik modellenmesi anlatılmıştır. Bölüm 3 te GPC yapısı ve tasarlanan kontrolör yapısı sunulmuştur. Bölüm 4 te ise yapılan simülasyon çalışmaları sunulmuştur. 2. ALTI EKLEMLİ ROBOT KOLUNUN DİNAMİK MODELİ Çalışmada kullanılan altı eklemli PUMA 560 robot kolu Şekil de ve kolun temel parametreleri Çizelge de verilmiştir [2]. Burada i; eklem sayısını, α i ; x r i ekseni etrafında z r i ekseninden z r i eksenine kadar olan açıyı (sağ el kuralı kullanılarak, a i ; z r i ve z r i eksenleri arasındaki en kısa mesafeyi, d i ; z r i ekseni boyunca ( i. koordinat çerçevesinin orijininden x r r i ekseni ile z i ekseninin kesişme yerine kadar olan mesafeyi gösterir. Robot kolunun dinamik model çözüm için Lagrange-Euler denklem sistemi kullanılmıştır. Bu yönteme göre n eklemli bir robot kolu için nx boyutlu eklem tork vektörü τ (t ile nx boyutlu eklem açı vektörü θ (t arasındaki ilişki Denklem ( deki gibi doğrusal olmayan bir diferansiyel denklem takımı ile gösterilir [3]. 24

Şekil. Altı eklemli robot kolu D( θ & θ + H( θ, & θ + G( θ + τ ( t + τ ( t = τ ( t ( s l &,θ & ve θ sırasıyla eklemlere ait ivme, açısal hız ve posizyonu temsil eden n-boyutlu vektörlerdir. ( Burada θ & D θ, nxn boyutlu simetrik atalet matrisidir. H ( θ, & θ, Coriolis ve merkezkaç kuvvetini temsil eden n-boyutlu vektördür. G(θ yerçekim kuvvet vektörü, τ s (t sürtünmeyi temsil eden kuvvet vektörü, τ l (t uç noktadaki yük etkisini temsil eden kuvvet vektörü ve τ (t ise genelleştirilmiş tork vektörüdür [3]. Çizelge. Puma 560 robot koluna ait Denavit-Hartenberg parametreleri i (eklem no α (derece θ a (metre d (metre i i -90 θ 0 0 2 0 θ 2 0.438 0.49 3 90 θ 3-0.0203 0 4-90 θ 4 0 0.433 5 90 θ 5 0 0 6 0 θ 6 0 0.056 i Dinamik modellemede robot kolunun sürtünmesi de göz önüne alınmış; statik, kinetik (Coulomb ve akışkan sürtünmesini içeren bir sürtünme modeli oluşturulmuştur [4]. Bu model aşağıdaki denklem ile gösterilmektedir. i q& fs sgn( τ sürtünme= + fk tanh 2 q& + x s ( q& + k ( q& vn (2 Burada f s statik sürtünme, x s Stribeck Etkisinden oluşan statik sürtünme sabiti, f k kinetik sürtünme ve kvn akışkan sürtünmesidir. Puma 560 robot koluna ait sürtünme parametreleri Çizelge 2 de verilmiştir [5]. Çizelge 2. Puma 560 sürtünme parametreleri 25

i(eklem no ƒ s ƒ k k vn X s 5 2 0. 2 5 2 0. 3 2.5 0. 4 0.3 0. 0.05 0. 5 0.2 0. 0.05 0. 6 0.2 0. 0.05 0. Robot kolunun uç noktasında taşınan yükün dinamik modele etkisi aşağıdaki denklem ile temsil edilir. T τ ( & θ T & & T v y t = m J J + mj J θ mj g = m L( θ, & θ, & θ (3 Burada, J, robot kolunun Jacobian matrisi, g v, yer çekim ivme vektörü, m, uç noktada taşınan yükün kütlesi ve L θ, & θ, & θ, birim yük başına düşen ilave tork değeridir []. ( Bu çalışmada yörünge planlaması için sinüzoidal yörünge planlaması kullanılmıştır. Hareketin yörüngesi Şekil 2 de verilmiştir. Buna göre her bir ekleme ait referans açı (pozisyon ve açısal hız değerleri aşağıdaki şekilde hesaplanır []: θ ( t = a + bcos ( w t & θ ( t = b w Sin ( w t π w =, θ f +θ 0 a =, θ f θ 0 b = ( t 2 2 f (4 (5 (6 θ f + θ0 θ f θ0 π i θ [ i] = ( ( Cos( 2 2 n, i = 0Ln (7 Açısal hız denklemi aşağıdaki gibi türetilir: & θ f θ0 π π i θ [ i] = ( ( Sin ( (8 2 t f n Burada, t f, toplam simülasyon süresi, θ f, i. eklemin başlangıç pozisyonu, θ 0, i. eklemin bitiş pozisyonu, n ise eklem sayısıdır. Şekil 2. Hareketin yörünge planlaması 26

Robot kolunun uç nokta koordinatları aşağıdaki gibi hesaplanır [2]: [ d6( cos( θ2 + θ3 cosθ4 sinθ5 + sin( θ3 + θ3 cosθ5 + d4 sin( θ2 + θ3 + a3 cos( θ2 + θ3 + a2 cosθ2] * cosθ ( d2 d6 sinθ4 sinθ5 sinθ Px = + [ d6( cos( θ2 + θ3 cosθ4 sinθ5 + sin( θ3 + θ3 cosθ5 + d4 sin( θ2 + θ3 + a3 cos( θ2 + θ3 + a2 cosθ2] sinθ + ( d2 d6 sinθ4 sinθ5 cosθ Py = + ( cos( θ2 + θ3 cosθ5 sin( θ2 + θ3 cosθ4 sinθ5 + d4 cos( θ2 + θ3 a3 sin( θ2 + θ3 a2 θ2 Pz = d6 sin (9 Sürtünme, motor ataletleri ve uç noktada taşınan yükün etkisini de içeren en genel anlamda bir dinamik model oluşturulmuştur. Lagrange-Euler denklem sistemi ile modellenen bu yapıda birbirleriyle yüksek oranda etkileşimli altı adet ikinci dereceden doğrusal olmayan diferansiyel denklem mevcuttur. Bu tip denklemlerin çözümü için klasik nümerik çözümler kullanılamadığından özel metotların kullanılması gerekmektedir. Bu çalışmada, dinamik modelin denklem takımının çözümü için 4. dereceden Runge-Kutta integrasyon metodu kullanılmıştır []. 3. GENELLEŞTİRİLMİŞ ÖNGÖRÜLÜ KONTROLÖR TASARIMI Genelleştirilmiş Öngörülü Kontrol (Generalized Predictive Control - GPC, uzun menzilli öngörülü kontrol algoritmaları sınıfına ait olup ilk olarak D. W. Clarke ve arkadaşları tarafından 987 yılında tanıtılmıştır [5-9]. GPC, esas olarak sistem çıkışı y(t nin sonlu bir ufuk üzerinden öngörüldüğü ve kontrol sinyalleri dizisinin kuadratik bir maliyet fonksiyonunu minimize edecek şekilde hesaplandığı bir algoritmadır. Uygun cevabı elde etmek için kontrol sinyallerinin beklenti büyüklüklerinde bazı tahminler yapılmaktadır, bu tahminler GPC yaklaşımının püf noktasını teşkil eder. GPC, tek bir öngörü yerine sonlu bir öngörü ufuğu boyunca oluşturulan öngörü dizilerini kullanan daha genel bir maliyet fonksiyonuna sahip olması ile kendinden önce yapılan öngörülü çalışmalardan esaslı bir şekilde farklıdır [0, ]. Öngörülü kontrol algoritmasının esası temel olarak; bir öngörücü, bir maliyet fonksiyonu, bu maliyet fonksiyonunu minimize edecek bir kontrol dizisini seçme algoritması ve adaptif durumda parametre tanılama algoritmasının birleşmesinden meydana gelmektedir. GPC algoritmasının blok diyagramı Şekil 3 de verilmiş olup u sistem girişi, y sistem çıkışı, y r ise referans yörünge vektörüdür. Parametre kestirimi uygun bir parametre kestirme algoritması ile yapılır. y r y Kestirilen parametreler Kontrolör Parametre kestirici u u y Gerçek Sistem veya Simülatörü y Şekil 3. GPC Algoritmasının Blok Diyagramı GPC algoritmasında CARIMA formunda (Controlled Auto Regressive Integrated Moving Average doğrusal bir işlem modeli kullanılmaktadır [5-9]. Denklemi (0 da verilmiştir. GPC algoritması bu model sayesinde kararsız sistemler için bile doğru çıkış öngörüleri elde edebilmektedir. A( q y( t = B( q u( t + C( q ξ ( t / Δ (0 A ( q, B ( q, C ( q parametreleri m m lik matris düzeyinde polinom değişkenlerdir ( m = eklem sayısı. 27

n a j A ( q = Ιm + a j q, j B ( q = b j q, j C ( q = Ιm + c j q j= j= 0 j= n b n c ( n a, n b, n c polinom mertebeleridir. Ι m m m lik birim matristir. Hesaplamalarda kolaylık olması açısından n c = 0 alınacak, yani C ( q ihmal edilecektir. Δ = q, fark alma operatörüdür ( Δu j ( t = u j ( t u j ( t. / Δ ifadesi ise integratör görevi görerek hatayı daha da azaltır. Bu durumda hata e( t = ξ ( t / Δ olur. Maliyet fonksiyonu kontrolün başından sonuna kadar her kontrol adımı sonunda sisteme uygulanacak uygun Δ u(t yu bulmak için gerekli olup denklemi (2 de verilmiştir [0]. N 2 J ( N, N2, Nu = r r j= N j= T T ( yˆ( t + j y ( t + j ( yˆ( t + j y ( t + j + ( Δu( t + j Λ( j ( Δu( t + j N u (2 Burada y ˆ( t + j herhangi bir ( t anında öngörülen sistem çıkışını, y r ( t + j sistemin referans çıkışını, Δu( t + j kontrol sinyalindeki değişim miktarını, N başlangıç ufku, N 2 bitiş ufku ve Nu ise kontrol ufkunu temsil eder. λ ( j ise kontrol ağırlık faktörü olup oldukça küçük seçilir ( λ 0 6 gibi. Referans yörüngeler ne kadar yakın takip edilirse kontrol o kadar güçlü olur. Bu takibi sağlamak için önce maliyet fonksiyonu J J minimize edilir. Yani ~ = 0 yapılır. Sonra u ~ çekilerek aşağıdaki denklem elde edilir. u u ~ = T T ( G G + Λ G ( y f r (3 Bütün kontrol adımlarında bu denklem kullanılır. Kontrol bitene kadar her kontrol adımı sonunda u ~ nin ilk elemanı Δ u(t alınır. Bir önceki kontrol girdisi ile toplanarak yeni kontrol girdisi ( u( t = u( t + Δu( t elde edilir ve sisteme uygulanır. Fakat G ve f fonksiyonlarını belirleyen A ( q ve B ( q parametrelerinin her kontrol adımı sonunda tekrardan hesaplanması gerekir. Bu iş için bir parametre kestirim algoritmasına ihtiyaç vardır. Bu çalışmada yakınsama açısından daha hızlı olduğundan ardışık en küçük kareler algoritması kullanılmıştır [6]. 4. SİMÜLASYON SONUÇLARI Bu çalışmada, altı eklemli bir robot kolunun yörünge kontrolü için genelleştirilmiş öngörülü kontrolör tasarlanmış ve simülasyon ortamında test edilmiştir.. Tasarlanan kontrolör, kolun hareketi boyunca referans modelden gelen her bir ekleme ait referans yörüngeleri takip edecek eklemlere ait uygun tork değerlerini üretmektedir. Kontrolör, referans yörünge ve robot kolu dinamik modelinden elde edilen pozisyon (açı bilgilerini girdi olarak alır ve sisteme (robot koluna uygulanacak tork değerlerini çıktı olarak üretir. Üretilen torklar eklemlere uygulanır. Tasarlanan GPC kontrolör, CARIMA formunda doğrusal bir öngörü modeli kullanır. Geçmiş tork değerleri ve sistemden elde edilen pozisyon verilerini kullanarak sonraki adımlarda eklemlere uygulanacak tork değerlerini öngörür. Öngörülen değerler maliyet fonksiyonuna yerleştirilir. Referans yörünge ile öngörülen yörünge arasındaki hata minimize edecek uygun tork değişim vektörü Δu(t hesaplanır. Hesaplanan bu değer bir önceki tork değerine eklenerek u( t = u( t + Δu( t sisteme uygulanır. Hareket sonuna kadar bu işlemler tekrarlanır. Öte yandan her kontrol adımında öngörü modelindeki parametrelerin güncellenmesi gerekir. Bunun için bir parametre kestirim algoritmasına ihtiyaç duyulur. Bu çalışmada literatürde çok tercih edilen parametre kestirim algoritması olarak Ardışık En Küçük Kareler Yöntemi (Recursive Least Squares RLS kullanılmıştır [6]. Simülasyon çalışmaları için aşağıda verilen örnek bir kontrol senaryosu düşünülmüştür: 28

Toplam simülasyon zamanı 0 sn ve toplam kontrol adımı 0000 olarak belirlenmiştir. 4000. adımda uç noktada taşınan yükün düştüğü varsayılmıştır. Aşırı hesaplama yükünden kaçınmak için geçmiş üç çıkış (pozisyon ve üç giriş(tork bilgisi kullanılarak gelecek üç adım sonrasına kadar öngörü işlemi yapılmıştır. Bu durumda n a =2 ve n b = olarak seçilmiştir. Maliyet fonksiyonu parametrelerinde başlangıç ufuğu; N =, bitiş ufuğu; N 2 =3 ve kontrol ufuğu N u = olarak alınmıştır. Çizelge 3 de verilen örnek kontrol uygulamasında eklemlere ait başlangıç ve bitiş açıları için eklemlere ait yörünge ve açısal hız eğrileri Şekil 4 deki gibi elde edilmiştir. Çizelge 3. Örnek uygulama için eklemlere ait başlangıç ve bitiş açıları Eklem no. Başlangıç Açısı (rad Bitiş Açısı (rad -0.872664625997 0.872664625997 2-0.6086523898-0.349065850399 3 0.6983700798.047975597 4-0.6983700798 0.349065850399 5 0.7453292599 0.349065850399 6.047975597.39626340595 Şekillerde görüldüğü gibi eklemler referans yörüngelerini oldukça yakın takip etmişlerdir. Hareket başlangıcında hareketsiz durumdaki robot kolunun eylemsizliğinden kaynaklanan hatalar görülmektedir. Ayrıca yük düşme anında kısa süreli salınımların ardından kontrolör bu duruma kendini adapte etmekte ve hızlı bir şekilde referans yörüngeleri yakalayabilmektedir. Her iki durumda da kontrolör adaptif bir davranış sergilemektedir. Verilen örnek kontrol çalışması için eklemlerin konum hataları ve robot kolunun uç nokta koordinat hatası Çizelge 4 de verilmiştir. Eklemler çok küçük hatalar ile hedef konumlarına ulaşmışlardır. Çizelge 4. Eklemlerin konum hataları Eklem no. Konum hatası (rad Uç nokta koordinat hatası (mm -0.0000663653 2 0.0006922222 3-0.00033960305 0.47009652329 4-0.0000056456 5 0.00067969520 6-0.000003072 29

Şekil 4. Eklemlere ait yörünge ve açısal hız grafikleri Geleneksel kontrolörlere alternatif olan öngörülü kontrol, robot kolu kontrolü gibi referans yörüngelerin önceden bilindiği kontrol uygulamaları için oldukça başarılıdır. Öngörülü kontrol değişken yük (örneğin yük düşmesi gibi bilinmeyen ve istenmeyen durumlarda bile sistem çıkışlarını istenilen çıkışlara yakınsatacak şekilde sonuçlar üretebilmektedir. 30

KAYNAKÇA [] H. Temurtaş, Üç Eklemli Bir Robot Kolunun Nöro Genelleştirilmiş Öngörülü Kontrol İle Eklem Esaslı Yörünge Kontrolü, Doktora Tezi, Sakarya Üniversitesi Fen Bilimleri Enstitüsü, (2004. [2] F.C. Sun, Z.Q. Sun, and P.Y. Woo, Neural network-based adaptive controller design of robotic manipulators with an observer, IEEE Transactions Neural Networks, 2 (, 55 (200. [3] F. Alonge, F.D. Ippolito, and F.M. Raimondi, An adaptive control law for robot manipulators without velocity feedback, Control Engineering Practice,, 000 (2003. [4] O. Nasisi and R. Carelli, Adaptive servo visual robot control, Robotics and Autonomous Systems, 43, 54 (2003. [5] D.W. Clarke, C. Mohtadi, and P.C. Tuffs, Generalized predictive control - part : The basic algorithm, Automatica, 23, 37-45 (987. [6] D.W. Clarke, C. Mohtadi, and P.C. Tuffs, Generalized predictive control - part 2: The basic algorithm, Automatica, 23, 49-63 (987. [7] D.W. Clarke, C. Mohtadi, and P.C. Tuffs, Generalized predictive control: A new robust self-tuning algorithm in landau, I. D., and L. Dugard (Editors. Commande Adaptive - Aspects Pratiques et Theoriques, Masson, Paris, 220 (987. [8] D.W. Clarke and L. Zhang, Long-range predictive control using weighting-sequence models, Control Theory and Applications, 34(3, 94 (987. [9] D.W. Clarke and C. Mohtadi, Properties of generalized predictive control Automatica, 25(6, 870 (989. [0] J. Zhang, J. Wei, and T. Zhong, A generalized predictive controller to a thermal process for batch dyeing process, International Conference on Information Acquisition 2004, China, 433 (2004. [] J.E. Normey-Rico and E.F. Camcho, Robust design of GPC for process with time delay, International Journal Robust Nonlinear Control, 0(3, 0 (2000. [2] B. Armstrong, O. Khatib, and J. Burdick, The explicit dynamic model and inertial parameters of the PUMA 560 arm, IEEE Conference on Robotics and Automation, 3, 56 (986. [3] M.W. Spong and M. Vidyasagar, Robot Dynamics and Control, John Wiley & Sons, New York, 50 (989. [4] J. Draye, D. Pavisic, G. Libert, Dynamic recurrent neural network: a dynamical analysis, IEEE Transactions on Systems Man and Cybernetics Part B 26(5, 700 (996. [5] J. Rodrigo, H.A. Marcelo, D. Oetomo, O. Khatib, T.M. Lim, S.Y. Lim, The operational space formulation implementation to aircraft canopy polishing using a mobile manipulator, International Conference on Robotics&Automation, Whashington D C. USA, 400 (2002. [6] F. Temurtas, H. Temurtas, and N. Yumusak, Application of neural generalized predictive control to robotic manipulators with a cubic trajectory and random disturbances, Robotics and Autonomous Systems, 54, 82 (2005. 3

32