Penerapan Inverse Kinematic Pada Pengendalian Gerak Robot

Transkripsi

1 Penerapan Inverse Kinematic Pada Pengendalian Gerak Robot Danang Yufan Habibi Jurusan Teknik Elektro - FTI, Institut Teknologi Sepuluh Nopember Kampus ITS, Keputih - Sukolilo Surabaya 0 ABSTRAK: Pada Makalah ini disajikan metode penerapan dan analisis kinematika dari robot berkaki enam (hexapod). Setiap kaki terdiri atas tiga sendi berputar dengan 3 derajat kebebasan mengadopsi struktur kaki serangga dengan beberapa penyederhanaan. Denavit-Hartenberg (D-H) convention digunakan untuk analisis forward kinematic, sedangkan inverse kinematic diturunkan menggunakan analisis geometri menggunakan fungsi trigonometri. Gerakan langkah kaki disusun menggunakan trayektori polinomial orde untuk fase berayun (transfer phase) dan fase menopang (support phase). Tiga macam pola berjalan/ gait (pentapod, tetrapod, dan tripod ) dibangun sebagai pengkoordinasi gerakan kaki sehingga robot dapat berjalan. Kata Kunci: Robot hexapod, inverse kinematic, trayektori kaki, algoritma gait.. PENDAHULUAN Kelebihan robot berkaki dibandingkan dengan tipe beroda yaitu dapat menjelajah pada medan kasar atau menaiki tangga. Aplikasi robot berkaki umumnya untuk penjelajahan alam bebas pada misi militer, penjelajahan hutan, dan juga untuk eksperimen perilaku hewan dan pengujian kecerdasan buatan (AI). Hexapod dapat berjalan secara stabil statis dengan menyangga tubuh robot maksimal menggunakan lima kaki setiap saat. Sendi pada kaki robot umumnya digerakkan oleh motor DC yang dilengkapi gearbox untuk mereduksi kecepatan putarnya. Beberapa robot berkaki berukuran kecil menggunakan penggerak motor servo. Motor servo adalah motor DC yang dilengkapi kontrol posisi sudut putaran dengan masukan setpoint sudut berupa sinyal PWM. Metode konvensional untuk membuat sebuah robot berkaki berjalan adalah dengan menentukan simpangan dan pewaktuan masing masing sendi untuk membuat robot berjalan kemudian memasukkannya kedalam tabel lookup. Dengan trial & error, masing masing PWM servo dan timing antar servo untuk membuat gerakan kaki dapat dapat ditentukan. Metode ini tidak memerlukan komputasi rumit tetapi tidak fleksibel untuk membuat gerakan yang baru atau beragam. Untuk menggerakkan kaki robot dengan lebih fleksibel diperlukan beberapa algoritma untuk mengendalikan motor penggerak sendi diantaranya adalah kinematika balik (inverse kinematic) untuk menentukan besar sudut masing-masing sendi saat ujung kaki berada pada suatu koordinat tertentu, perencanaan trayektori digunakan untuk membentuk lintasan pergerakan ujung kaki robot, gait pattern untuk mengatur koordinasi masing-masing kaki untuk membentuk suatu pola pergerakan dasar dari robot. Diharapkan robot hexapod ini memiliki pola pergerakan kaki yang halus, presisi, dan cepat, untuk aplikasi robot berjalan dan lebih mudah dikembangkan untuk membentuk pola pergerakan lainnya. Penelitian ini dilakukan menggunakan robot hexapod 3DOF tipe MSR-H0 buatan microsystem dengan aktuator sendi berupa motor servo posisi dan modul pengendali motor servo SSC3 sebagai driver motor. Sedangkan algoritma ditulis dalam program aplikasi MATLAB dan menggunakan komunikasi serial sebagai penghubung MATLAb dengan SSC3.. KINEMATIKA KAKI ROBOT Pada Gambar. menunjukkan model 3-D dari sebuah robot berkaki enam yang digunakan dalam penelitian ini, Terdiri dari badan robot yang berbentuk persegi panjang dan enam kaki identik yang didistribusikan ke kedua sisi badan robot. Setiap kaki memiliki tiga derajat kebebasan. Desain persegi panjang adalah desain yang lebih mirip dengan bentuk binatang, desain ini cocok digunakan untuk gerakan maju, walaupun kurang fleksibel dalam berbelok, bergerak menyamping atau bergerak mundur [Woering R,0]. Gambar. Robot Hexapod MSR-H0 Dari Microsystem

2 b T 0,i =[ cosβ i sinβ i 0 x offset,i ] cosβ i sinβ i 0 y offset, i...() Gambar. Konstruksi Kaki Gambar merupakan bentuk model dari kaki robot, Z0 adalah base frame dari kaki, sedangkan Zb adalah frame pusat dari robot yang terletak di tengah tengah badan robot. Parameter dari kaki robot ditunjukkan oleh Tabel. Table. Parameter D-H kaki robot Link αi li θi di -90 l θ 0 0 l θ l3 θ3 0 Hasil dari transformasi matrik antara ujung kaki dengan base frame Z0 adalah sebagai berikut: C 3 C S 3 S C (l +l C +l 3 C 3) T 0 S 3 =[C C 3 S S 3 C S (l +l C +l 3 C 3 ) S 3 C 3 0 l 3 S 3 +l S...() Dari matrik T diatas maka persamaan forward kinematic dari kaki 3DOF ini adalah [ x y z] =[C (l +l C +l3c 3) ] S (l +lc +l 3 C 3 )...() l 3 S 3 +l S Inverse kinematic diturunkan dengan metode geometri menghasilkan persamaan 3, 4,dan 5. θ =atan( y x)...(3) ] 3. TRAYEKTORI UJUNG KAKI Algoritma trayektori kaki bekerja pada bidang x, y, z, tetapi untuk gerakan lurus maju (γ=0) trayektori hanya bekerja dalam bidang y. Posisi x ditentukan dengan memperhitungkan nilai sudut serong γ. Untuk memudahkan analisa trayektori akan dibagi menjadi bidang x-y dan bidang z-y. Trayektori yang digunakan adalah trayektori polinomial orde. Berikut adalah persamaan trayektori polinomial orde untuk bidang x-y. y(t)=a 0 +a t y' (t)=a...(7) y didefinisikan sebagai posisi saat waktu t dan y' adalah turunan posisi yaitu kecepatannya. Orde memiliki kecepatan yang tetap selama perpindahan dari y(t) menuju y(t+n) yakni sebesar a. Posisi x dapat ditentukan dengan x(t)=y(t)tan(γ) dan x'(t)=y'(t) Kecepatan gerak ini berbeda antara saat fase support dan fase transfer. Notasi a0 adalah posisi mula-mula dari langkah kaki yang kita kenal dengan AEP (Anterior Extreem Position) atau PEP (Posterior Extreem Position). Berikutnya untuk bidang y-z menggunakan Persamaan 8 berikut ini [Figliolini G, dkk, 007]. z(t )={0 i support phase(t β) Fcsin(π t t 0...(8) ) transfer phase(t>β)} i i t f t 0 Kurva saat kaki mengangkat dibentuk dengan kurva sinusoidal. Fc sebagai amplitudo kurva menunjukkan tinggi maksimal kaki melangkah atau disebut dengan foot clearence. Persamaan trayektori kurva sinusoidal hanya dipakai saat fase transfer, saat fase support koordinat z bernilai nol. θ 3 =±acos( l +l 3 (r l ) z )...(4) l l 3 z θ =atan( )±acos( l +(r l ) +z l 3 )...(5) r l l (r l ) +z Persamaan ke- kaki robot harus disatukan dalam satu frame untuk menyelesaikan kinematika robot. Berdasarkan Gambar 4, dengan i menunjukkan urutan kaki, matrik transformasi dari koordinat lokal ke koordinat global dapat disusun sebagai berikut. Gambar. Kurva Trayektori Kaki

3 4. POLA LANGKAH Dengan pembangkit trayektori dan inverse kinematic, kaki robot sudah bisa melangkah. Pada bagian ini algoritma gait diperlukan untuk mengatur kapan sebuah kaki berada pada fase support atau fase transfer. Prinsip perancangan algoritma gait disini adalah semua gerakan masing masing kaki adalah sama, yang berbeda adalah waktu tunda atau beda fase antar masing masing kaki [Woering R., 0]. Tiga jenis gait diaplikasikan disini yaitu gait pentapod, tetrapod dan tripod. Urutan langkah kaki ditunjukkan pada gambar 3 dengan bar hitam mewakili fase support dan spasi mewakili fase transfer. Gait Gait t Gait 3 Gambar 3. Diagram Gait Untuk membangkitkan gelombang gait dilakukan dengan sebuah tabel look-up dengan θn adalah waktu tunda setiap kaki dalam T ternormalisasi, di akhir setiap baris dalam tabel lookup adalah duty factor β. FASE( j, n)=[θ θ θ 3 θ 4 θ 5 θ β]...(9) beda fase untuk gait pentapod adalah berikut, FASE=[ 5 4 selanjutnya untuk gait tripod FASE=[ (0) ]...() 3] sedangkan untuk gait tripod adalah sebagai berikut FASE=[ Leg Leg Leg Leg Leg Leg Leg Leg Leg ]...() Beberapa gait dalam Persamaan 0,, digunakan pada algoritma pembangkitan gait hexapod yang ditunjukkan oleh Gambar 4. Gambar 4. Diagram Alir Pembangkitan Gait 5. MANUVER GERAKAN ROBOT Gerakan robot terdiri dari gerakan dasar, yaitu gerakan jalan lurus, dan gerakan berputar. 5.. Gerakan Jalan Lurus Prinsip dari pergerakan lurus adalah koordinat kaki saat memulai dengan koordinat akhir saat fase support dihubungkan oleh garis lurus. Variabel dari gerakan ini adalah panjang langkah Fs dan sudut serong γ. Gambar 5 memperlihatkan koordinat global robot dan transformasi ke koordinat awal dan akhir dari kaki ke-. Garis a-b berwarna biru adalah garis yang dibentuk oleh trayektori dengan panjang Fs diukur dalam koordinat global, kemudian garis tersebut di transformasi ke masing masing kaki robot dan digambarkan dalam garis merah. a γ Y y_loc x_offse t y_offse y_glo b x_loc X b Gambar 5. Penempatan Kurva Trayektori Untuk Gerakan Lurus cr β' L AEP L PE P

4 Pada pergerakan ini bentuk langkah dan panjang langkah sama untuk semua kaki, sehingga hanya perlu satu perhitungan saja kemudian didistribusikan ke semua kaki. Langkah pertama untuk membuat gerakan jalan lurus adalah membuat kurva lintasan kaki pada vektor F yang mempunyai ujung titik a dan b menggunakan persamaan trayektori yaitu, F (t)= (t ) v Δt {F r support phase(t β) F (t )+v p Δ t transfer phase(t>β)}...(3) Dengan memasukkan variabel γ koordinat x dan y dihitung dengan persamaan, Leg 75 Global Coordinat 30 y 50 Leg Local Coordinat r β a x P b x(t )= sin(γ)f (t )...(4) y (t)= cos(γ) F (t ) dan koordinat z adalah sebagai berikut, Leg z(t )={0 i support phase(t β) Fcsin(π t t 0...(5) ) transfer phase(t>β)} i i t f t 0 Dengan mengamati Gambar 5, cr merupakan jarak aman operasional kaki diukur pada sumbu x lokal masing masing kaki, dan β merupakan sudut putar koordinat lokal terhadap sumbu z, maka, L i =cr cos(β i ) L i =cr sin (β i )...() x_offset dan y_offset adalah jarak titik pusat koordinat lokal diukur dari pusat koordinat global, koordinat kurva trayektori kaki jika didistribusikan ke masing masing kaki menggunakan Persamaan 7. x i (t)=x offset i +L i+x(t) y i (t)= y offset i +L i+y (t) z i (t )=z(t) 5.. Gerakan Berputar...(7) Gambar memperlihatkan kurva langkah kaki gerakan berputar yang akan dibentuk oleh ujung kaki yang berpusat di origin koordinat global. Metode untuk membuat gerakan berputar adalah membangkitkan posisi sudut dari ujung kaki menggunakan Persamaan 3 dengan F sebagai fungsi sudut. Setelah posisi sudut diketahui barulah dihitung posisi x, y dan posisi z. Langkah pertama adalah menentukan sudut acuan α, kurva dari trayektori sudut memiliki nilai tengah pada sudut α yangdicari dengan Persamaan 8. Gambar. Penempatan Kurva Trayektori Untuk Gerakan Berputar Sudut γ adalah sudut putar robot yang diinginkan, jika γ bernilai positif berarti robot berputar berlawanan jarum jam sepanjang γ, maka sudut mula mula dari gerakan ini adalah angle i (0)=α i γ...(9) Selanjutnya dengan Persamaan 5 dengan fungsi F sebagai fungsi sudut (angle_i), posisi sudut masing masing kaki dihitung menggunakan persamaan berikut, angle i (t)= i(t) v r Δ t support phase(t β) {angle i (t)+v p Δ t transfer phase(t >β)} (0) Setelah sudut diketahui, langkah selanjutnya adalah mengkonversi sudut ke koordinat x dan y menggunakan Persamaan 3, sedangkan koordinat z didapat dari Persamaan 7. x i (t )=cos(angle i (t )) P i x +P i y y i (t)=sin(angle i (t )) P i x +P i y...(). HASIL PERANCANGAN DAN PENGUJIAN Gambar 7 berikut ini menunjukkan bentuk simulasi robot pada program aplikasi MATLAB. P i x= x offset i + L i P i y= y offset i +L i α i =atan ( P i x P i y )...(8) Gambar 7. Bentuk Simulasi Robot

5 Kinematika kaki robot mempunyai area kerja tertentu, untuk menentukan daerah kerja dari kaki robot harus diperhatikan konstruksi mekaniknya yakni penempatan aktuator motor servo dan keterbatasan sudut yang dapat dibentuk oleh motor servo. Tabel menunjukkan variabel dan parameter dari kaki robot untuk analisa workspace atau daerah kerja kaki robot [Gouda B.K., 00]. Tabel. Batasan Sudut Sendi Kaki Robot Sendi Panjang lengan (mm) Sudut minimum (º) Sudut maximum (º) Sendi Sendi Sendi Analisa berikutnya adalah kurva trayektori. Kurva saat kaki mengangkat dibentuk dengan kurva sinusoidal. Fc sebagai amplitudo kurva menunjukkan tinggi maksimal kaki melangkah atau disebut dengan foot clearence. Persamaan trayektori kurva sinusoidal hanya dipakai saat fase transfer, saat fase support koordinat z bernilai konstan. Bentuk kurva langkah kaki terdapat pada Gambar 0. Waktu t adalah iterasi dengan Δt tertentu dalam satuan detik, iterasi t menentukan seberapa banyak titik yang dihasilkan untuk berpindah dari AEP ke PEP yang berarti semakin banyak iterasi menghasilkan kurva yang halus tetapi waktu yang diperlukan akan semakin lama karena proses komputasi yang banyak, sebaliknya dengan iterasi yang minimum akan mempercepat proses perpindahan tetapi kurva yang dihasilkan menjadi kasar. Analisa gait (pola langkah) dilakukan dengan membandingkan antara kecepatan gerak robot dengan konsumsi arus pada kaki robot, berikut ini adalah salah satu grafik perubahan sudut dan arus listrik yang dibutuhkan oleh kaki robot. Gambar 8. Workspace 3D Kaki Robot Pada Gambar 8 diatas menunjukkan area kerja yang dapat dijelajahi oleh ujung kaki dengan besar sudut sendi seperti pada tabel dengan step 0º. Gambar 8 dan Gambar 9 merepresentasikan grafik D untuk memperjelas tampilan area kerja dari kaki sehingga dapat dilihat bahwa tinggi robot yang dapat dijangkau dan panjang langkah yang dapat dibentuk oleh kaki robot. Gambar. Perubahan Sudut Dan Arus Yang Dibutuhkan Kaki Ke-3 Pada Mode Gerakan Lurus Tabel 3 berikut menunjukkan perbandingan kecepatan dan konsumsi arus dari semua mode gait dengan panjang langkah Fs= 0mm dan cycle time T=s. Tabel 3. Tabel Perbandingan Gait Gait V mm/s Gerak Lurus Konsumsi Arus (ma) Gerak Berputar V rad/s Konsumsi Arus(mA) Jumlah Kaki Penopang Pentapod 33,3 70,5 0,39 5,8 5 Tetrapod 44,7 89,9 0, tripod 0,3 0,7 0, 3 Gambar 0. Kurva Trayektori Informasi dari tabel diatas adalah adalah gait yang paling efisien adalah gait tripod karena dengan konsumsi arus yang tidak terlalu beda dibandingkan gait lainnya

6 mampu memberikan kecepatan yang maksimal dan tetap mampu menjaga kestabilitas statis. Selanjutnya kecepatan maksimal dari ketiga jenis gait diuji pada bagian berikut ini. Pengujian Kecepatan dilakukan dengan menjalankan robot dengan Fs dan T bervariasi. Hasil pengujian ditunjukkan pada Gambar. servo telah mencapai kecepatan maksimal sehingga saat dioperasikan pada kecepatan melebihi kemampuannya, motor servo akan tetap berada pada kecepatan maksimalnya. 7. KESIMPULAN Algoritma inverse kinematic diimplementasikan untuk mengatur pergerakan robot hexapod 3DOF. Trayektori orde dirasa cukup handal untuk diterapkan pada robot dengan aktuator motor servo. Tiga jenis pola langkah (gait) digunakan untuk mengatur koordinasi gerakan kaki dalam berjalan dan pola tripod merupakan pola yang paling efisien untuk berjalan. Gerakan dasar yang dibangun disini adalah gerakan maju atau serong, dan gerakan berputar. Algoritma yang dibangun dan diaplikasikan mampu membuat robot hexapod MSR-H0 berjalan dengan kecepatan maksimal sebesar mm/detik menggunakan gait tripod dengan Fs=00cm dan T=detik. Kontrol open loop menunjukkan selisih antara kecepatan aktual dengan kecepatan referensi yang cukup besar karena pengaruh permukaan lantai dan kemampuan aktuator sendinya. Gambar. Pengujian Kecepatan Tabel 5. Pengujian Error Sudut Serong No Sudut serong β (rad) Set point 0 0,3 0,5 0,7,5 Sebenarnya -0,03 0,58 0, 0,45 0,7,5 Kecepatan maksimal dari robot didapatkan saat T= detik dan Fs=00mm, yakni menghasilkan kecepatan maksimal mm/s. Sedangkan kecepatan robot yang paling sesuai dengan set point adalah saat menggunakan T= detik. Terdapat selisih antara nilai set point dengan nilai sebenarnya, ini diakibatkan karena kaki robot yang mudah slip saat dioperasikan pada permukaan licin. Masalah ini bisa diatasi dengan memasang kontroler close loop untuk menjaga kecepatan dan sudut serong agar mendekati set point. Saat dioperasikan menggunakan T< terlihat selisih yang cukup besar, salah satu penyebabnya karena motor 8. REFERENSI Figliolini G., Stan S. D., Rea P., 007, Motion Analisys of Leg Tip of a Sig-Legged Walking Robot, IFToMM Wolrd Congress. Gouda Bhanu K.,00, Optimal Robot Trajectory Planning Using Evolutionary Algorithms, Master's Thesis, C leveland State University. Linxmotion Inc., 005, Manual SSC-3. Woering R., 0, Simulating the "first steps" of a walking hexapod robot, Master's Thesis, University of Technology Eindhoven. BIODATA PENULIS Danang Yufan Habibi, lahir di Magelang pada tanggal 9 September 987. Mengawali pendidikan teknik di SMK Negeri Magelang bidang Teknik Elektronika, Komputer, dan Jaringan. Tahun 00 melanjutkan studi di Program Diploma Teknik Elektro Universitas Gadjah Mada. Setelah menyelesaikan masa studi tahun 009, kemudian melanjutkan program lintas jalur D3 ke S di Institut Teknologi Sepuluh Nopember Surabaya mengambil program studi Teknik Sistem Pengaturan. Robotika, elektronika analog, embedded system, sistem kontrol dan otomasi adalah bidang-bidang yang diminati semenjak duduk di perguruan tinggi.