DESAIN KONTROL PATH FOLLOWING QUADCOPTER DENGAN ALGORITMA LINE OF SIGHT

Seminar Nasional Inovasi Dan Aplikasi Teknologi Di Industri 2017 ITN Malang, 4 Pebruari 2017

ISSN 2085-4218

DESAIN KONTROL PATH FOLLOWING QUADCOPTER DENGAN ALGORITMA LINE OF SIGHT Anggara Trisna Nugraha 1) 1)

Jurusan Teknik Elektro, Fakultas Teknik, Institut Teknologi Sepuluh Nopember Jl. Raya ITS, Keputih, Sukolilo, Keputih, Sukolilo, Surabaya, Jawa Timur 6011 Email : [email protected]

Abstrak . Perkembangan Quadcopter sudah semakin luas fungsinya, bahkan untuk tugas-tugas militer di udara yang berbahaya, misalnya operasi pencarian, pengintaian, penyelamatan dan juga bisa diaplikasikan untuk tugas ilmiah seperti pemetaan kondisi kecepatan angin, mendeteksi sumber radiasi, pengawasan, pemeliharaan dan survei. Quadcopter merupakan sistem nonlinear dengan multiple input multiple output dan sistem dengan persoalan kestabilan, sehingga rentan terhadap gangguan eksternal. Karakteristik ini menyebabkan adanya kesulitan dalam pengendalian gerak tracking secara otomatis dan mengatur arah hadap. Berdasarkan permasalahan tersebut, pada penelitian ini disajikan desain kontrol tracking pada bidang horizontal dengan menambahkan algoritma Line of Sight, agar dalam melakukan path following konvergen menuju nol dan dapat mengatasi gangguan arus laut yang merubah parameter dari quadcopter dalam melakukan gerak pada bidang horizontal. Hasil simulasi menunjukkan bahwa metode kontrol yang digunakan mampu membawa sudut yaw, pitch dan roll pada nilai yang diharapkan. Quadcopter dapat melakukan tracking secara otomatis pada kondisi tanpa gangguan dengan rata-rata cross track error sebesar 0.8 meter. Kata kunci: Quadcopter, Tracking Control, Line Of Sight, Path Following.

1. Pendahuluan Saat ini teknologi Unmanned Aerial Vehicle (UAV) telah banyak digunakan dalam keperluan pengawasan, pencarian dan penyelamatan. Seiring berkembangnya metode yang digunakan untuk menangani permasalahan kontrol pada quadcopter yang mana [1], teknik kontrol nonlinear yang digunkaan untuk kontrol hover. Metode nonlinear backstepping lebih bisa mendekati karakteristik sistem nonlinear. Sehingga, langkah perhitungan yang digunakan lebih rumit. Walaupun dengan perhitungan rumit tersebut quadcopter mampu melakukan path following sesuai refrensi dari kondisi nilai x, y dan z. Namun pada saat quadcopter diberi gangguan berupa angin yang konstan maka respon yang dihasilkan mengalami ripple dan tidak robust. Pada [2] disajikan algoritma Line Of Sight (LOS) yang memudahkan untuk mengatur arah hadap suatu plant agar konvergen menuju path yang sudah didefinisikan, yaitu dengan membuat cross-track error yang dituju. Berdasarkan pada permasalahan dan solusi diatas, maka ide dalam penelitian yang akan diajukan adalah merancang desain metode kontrol optimal untuk mengontrol quadcopter agar dapat melakukan path following dengan jalur yang sudah ditentukan dan menambahkan algoritma Line Of Sight (LOS) yang digunakan untuk dapat menghasilkan kesesuaian terhadap suatu bentuk path sebagai sinyal referensi dengan mengatur arah hadap serta path error sekecil mungkin. 2. Pembahasan 2.1. Model Dinamika Translasi Quadcopter Suatu gaya yang dihasilkan oleh keempat motor penggerak yang dipasang baling-baling pada quadcopter. Persamaan berikut: menunjukkan gaya-gaya yang terjadi : U 1  F1  F2  F3  F4

(1)

U 2  F2  F4

(2)

U 3  F1  F3

(3)

B9.1


ISSN 2085-4218

U 4  F1  F3  F2  F4

(4)

Model Dinamika Rotasi Quadcopter Persamaan dinamika dari quadcopter pada gerak translasi dan rotasi adalah U x  (cos  sin  cos  sin  sin ) 1 m U y  (cos  sin  cos  sin  sin ) 1 m

(5) (6)

U z   g  (cos  cos  ) 1 m  

J yy  J zz J xx

 

Jr

qr 

q 

(7)

U

J xx

(8)

2 J xx

U J zz  J xx Jr pr  p  3 J yy J yy J yy

 

J xx  J yy J zz

pq 

(9)

U

4 I zz

(10)

dengan m adalah massa, g adalah gravitasi, l adalah jarak antara pusat massa quadcopter dengan sumbu rotasi propeller, d adalah koefisien gaya drag, dan Ix, Iy, Iz adalah inersia pada sumbu x, y, z berturut-turut.

Gambar 1. Gambar Semua State dari Quadcopter (e untuk Frame Bumi dan b untuk Frame Badan Quadcopter) [3]

2.2. Linearisasi Model Dinamika Quadcopter Pada bagian ini akan dijelaskan mengenai linearisasi dinamika quadcopter, dimana konsep dinamika sudah diterangkan pada sub-bab dinamika quadcopter. Nilai parameter, yang ditulis dalam tabel 1. variable state v , yang akan digunakan sebagai representasi dinamika pada aktuator quadcopter seperti berikut: v

 s 

Tabel 1. Parameter Sistem Quanser Qball-X4 3) No Parameter 1 Massa 2 Gravitasi 3 Moment Inersia pada sumbu X 4 Moment Inersia pada sumbu Y 5 Moment Inersia pada sumbu Z 6 Jarak rotor dari pusat massa 7 Gaya drag 8 Gaya trust B9.2

(11)

u

Simbol m g Jxx Jyy Jzz l d b

Nilai 3,499 kg 9,81 kg/m2 0.03 kg.m2 0.03 kg.m2 0.04 kg.m2 0.2 m 3,13x10-5 7,5x10-7


ISSN 2085-4218

9 Bandwith aktuator ω 15 rad/s 10 Konstanta gaya dorong K 120 N Pemodelan Linearisasi sudut Roll dan Pitch Asumsikan rotasi disekitar sumbu x dan y adalah decoupled, pergerakan dalam sumbu roll/pitch. Gaya angkat yang dihasilkan oleh setiap motor dapat dikalkulasi dan menggunakan input masingmasing yang berhubungan. Jika konstanta drag diabaikan dan quadcopter dianggap dalam kondisi melayang dimana percepatan quadcopter mendekati

  0.1  sin( )  0, cos( )  1   0.1  sin( )  0, cos( )  1 Bentuk kinematika sederhana roll, pitch dan yaw    1 0 0  p           0 1 0  q    0 0 1  r   

(12)

(13)

Sudut roll/pitch yang dimisalkan  , dapat diformulasikan menggunakan dinamika sebagai berikut:

J  FI

(14)

dengan J  J roll  J pitch , l adalah jarak propeller terhadap pusat gravitasi, dan F  F1  F2 terdapat perbedaan antara gaya yang telah dibangkitkan oleh kedua motor. Perbedaan gaya yang dihasilkan oleh perbedaan input untuk kedua motor yaitu,

u  u1  u2

(15)

Bentuk persamaan state space untuk model linier dinamika roll dan pitch dapat dinyatakan:   0       0  v  1      0       0  v  1   

0     0  lK T      0   0 u 2 J     0     v   

1

0     0  lK T        0 u1 J      0     v   

1

0

(16)

(17)

Pemodelan Linearisasi X dan Y Gaya angkat total dan perubahan sudut roll/pitch yang terjadi sepanjang sumbu X dan Y . Jika diasumsikan sudut yaw adalah nol maka, dinamika gerak dalam sumbu X dan Y dapat ditulis sebagai berikut:

x 

4F (sin  sin  cos  sin  cos ) m

(18)

y 

4F ( sin  sin  cos  sin  cos ) m

(19)

Percepatan sudut roll dan pitch mendekati nol yang diasumsikan, maka dengan mensubtitusikan, model posisi sumbu X dan Y dapat ditulis menjadi:

4KT 4F v sin   v m m

(20)

4K 4F v( sin  )   T v m m

(21)

x  y 

Model linier dinamika posisi yang didapat pada sumbu X dan Y dalam bentuk state space adalah sebagai berikut: B9.3


 x  0  x  0     v  0   y  0  y  0      v  0

1 0 0 1 0 0

0   x  0  4KT         x    0 u J     v    0  y  0  4KT         y    0 u J     v   

ISSN 2085-4218

(22)

(23)

T dimana X  [ x, y, z, u, v, w, , , , p, q, r ]

(24)

dan U  [U1 ,U 2 ,U 3 ,U 4 ]

(25)

 [ x, y, z, x, y , z, , , ,,, ]T

2.3. Algoritma Guidance Hukum LOS (Line of Sight) pada Persamaan Steering Strategi berdasarkan enclosure digunakan untuk mengarahkan menuju nol, kemudian mengarahkan vektor kecepatan menuju titik perpotongan agar sesuai dengan arah dari path, dimana path tersebut secara implisit didefinisikan oleh urutan di mana waypoints yang sudah didefinisikan. Path tersebut melibatkan secara langsung penetapan .

(26) Koordinat pusat suatu kendaraan didefinisikan dengan dan digunakan sebuah lingkaran dengan radius yang ditarik dari titik pusat kendaraan . Lingkaran tersebut akan memotong suatu path pada dua titik, dimana salah satu titiknya adalah . Perhitungan dua titik LOS yang tidak diketahui, dapat dicari dengan meyelesaikan dua persamaan dibawah ini: (27)

dimana persamaan merupakan persamaan pythagoras, sedangkan persamaan menunjukkan sudut kemiringan dari path terhadap sumbu bumi sebesar . Kemiringan diantara dua waypoints tersebut adalah konstan dan berlaku juga besar kemiringannya untuk titik-titik diantaranya. Proses perhitungan enclosure secara analitik berdasarkan [17] dapat dijabarkan dengan: Argumen 1: untuk , maka persamaan

(28)

dengan dan merupakan perbedaan posisi dan diantara dua waypoints. Koordinat pusat suatu kendaraan didefinisikan dengan dan digunakan sebuah lingkaran dengan radius yang ditarik dari titik pusat kendaraan . Lingkaran tersebut akan memotong suatu path pada dua titik, dimana salah satu titiknya adalah . Perhitungan dua titik LOS yang tidak diketahui, dapat dicari dengan meyelesaikan dua persamaan dibawah ini: (29) (30)

dimana persamaan (29) merupakan persamaan pythagoras, sedangkan persamaan (30) menunjukkan sudut kemiringan dari path terhadap sumbu bumi sebesar . Kemiringan diantara dua waypoints B9.4


ISSN 2085-4218

tersebut adalah konstan dan berlaku juga besar kemiringannya untuk titik-titik diantaranya. Proses perhitungan enclosure secara analitik dapat dijabarkan dengan: Argumen 1: untuk , maka persamaan

(31)

dengan dan merupakan perbedaan posisi dan diantara dua waypoints. Agar lebih mudah dalam melakukan proses perhitungan maka perlu dilakukan proses notasi baru sebagai permisalan:

(33)

dengan menjabarkan persamaan berikut, maka : (34)

dimana:

(35)

dimana:

(37)

kemudian pertimbangkan: (38)

Lalu, dengan memasukkan persamaan xlos dan y los kedalam persamaan

. maka: (39)

merupakan standar penyelesaian secara analitik persamaan orde dua. Kemudian, dinotasikan lagi dengan: (39) (40) (41)

maka solusi dari persamaanini menjadi: (42)

dimana:Jika

, maka :

(43)

dan jika

, maka:

(44)

B9.5


Setelah

ISSN 2085-4218

dihitung, maka dapat dengan mudah dihitung. Akan tetapi jika . Argumen 2: jika , maka hanya persamaan (2.164) yang berlaku, dalam arti bahwa:

, maka

(45)

dimana Jika

. Perhitungan persamaan (45) melalui syarat : , maka: (46)

dan jika

, maka: (47)

ketika , dengan program.

, maka tidak ada pilihan berdasarkan [2], namun saran penulis bisa dimodifikasi

2.4. Diagram blok quacopter Gambar 2 merupakan diagram blok dari strategi kontrol Quadcopter yang akan dirancang. Struktur kontrol terdiri model following, inner dan outer loop. Model following (yang ditandai dengan blok berwarna hijau) merupakan refrensi x dan y model dari generate path serta penggunaan algoritma LOS dengan output berupa sudut  d yang akan masuk dalam blok kontrol  , Inner loop merupakan kontroler rotasi sudut ( ,  , ) yang menambahkan peforma H (ditandai dengan blok berwarna kuning), sedangkan outer loop merupakan kontroler tracking posisi ( x, y, z ) yang menggunakan struktur CGT (ditandai dengan blok berwarna merah). Sinyal referensi untuk sistem kontrol quadcopter ini terdiri atas referensi untuk posisi xd , yd , z d dan sudut  d .

Gambar 2. Gambar Diagram blok kontroler quadcopter 2.5. Hasil dan Pembahasan Pengujian path following pada quadcopter secara otomatis dilakukan melalui simulasi, dengan adanya perubahan kecepatan angular. Kecepatan linear = 3,3, kecepatan sudut maksimal = 10, jarak arah hadap = 0,3 dan radius = 0,3. Titik yang akan dilalui untuk melakukan path following adalah sebagai berikut: Tabel 2. Koordinat Way point 1) No Titik (Way Point) Koordinat 1 Titik 1 (3, 1) 2 Titik 2 (3, 11) 3 Titik 3 (11, 11) 4 Titik 4 (11, 1) 5 Titik 5 (0.5, 1)

B9.6


ISSN 2085-4218

titik tersebut akan membentuk sebuah path (meter), adapun ilustrasi path yang akan dilalui oleh quadcopter ditunjukkan pada gambar 3.

Gambar 3. Gambar path yang terdefinisi. Dilakukan 2 pengujian path following menggunakan algoritma LOS (Line of Sight), yaitu pertama pengujian path following dengan kecepatan sudut 10m/s dan 20m/s. 2.1.1. Pengujian Path Following dengan kecepatan sudut 10m/s Pengujian gerak quadcopter dalam mengikuti suatu path (path following) tanpa adanya gangguan ekternal diilustrasikan pada gambar 4 dengan nilai error rata-rata posisi quadcopter terhadap path sebesar 0.8%.

Gambar 4. Gambar respon quadcopter terhadap path yang sudah terdefinisi dengan kecepatan 10m/s. 2.1.2. Pengujian Path Following dengan kecepatan sudut 20m/s Pengujian gerak quadcopter dalam mengikuti suatu path (path following) tanpa adanya gangguan ekternal diilustrasikan pada gambar 5 dengan nilai error rata-rata posisi quadcopter terhadap path sebesar 1.2%.

B9.7


ISSN 2085-4218

Gambar 5. Gambar respon quadcopter terhadap path yang sudah terdefinisi dengan kecepatan 20m/s. 3. Simpulan Algoritma LOS yang diterapkan pada quadcopter bekerja dengan baik ketika tidak ada gangguan ekternal dan mampu mengikuti jalur yang sudah didefinisi yang berupa square dan adanya perubahan kecepatan angular. Algoritma LOS mampu mengendalikan pergerakan quadcopter untuk melalui suatu path yang telah ditentukan dengan rata-rata cross track error kecil yaitu 0.8 meter dengan kecepatan 10m/s. 4. Saran Saran untuk penelitian selanjutnya dapat membahas pengujian dengan adanya gangguan eksternal pada quadcopter dalam melakukan steering, kontrol kecepatan dalam melakukan maneuver, dan penambahan desain observer untuk mengestimasi seluruh state agar mendekati dengan kondisi real. Daftar Pustaka [1].

[2]. [3].

David Cabecian, Rita Cunha, and Carlos Silvestre., “A Globally Stabilizing Path Following Controller for Rotorcraft With Wind Disturbance Rejection”, IEEE Transactions on Control Systems Technology Volume 23 issue 2, 2015. Thor I. Fossen., “Handbook of Marine Craft Hydrodynamics and Motion Control”, John Wiley & Sons, Inc., Canada, 2011. Quanser Q-Ball X-4 User Manual, Quanser Innovate Educate, 2010, Doc. 888 Rev.2 pp. i-46.

B9.8

DESAIN KONTROL PATH FOLLOWING QUADCOPTER DENGAN ALGORITMA LINE OF SIGHT

Recommend Documents