Perancangan dan Implementasi Embedded Fuzzy Logic Controller Untuk Pengaturan Kestabilan Gerak Robot Segway Mini. Helmi Wiratran

Transkripsi

1 Perancangan dan Implementasi Embedded Fuzzy Logic Controller Untuk Pengaturan Kestabilan Gerak Robot Segway Mini 1 Helmi Wiratran

2 2 Latarbelakang (1) Segway PT: Transportasi alternatif dengan motto Keep it green, A Clean, eco-friendly machine

3 3 Permasalahan Bagaimana menjaga Robot segway agar tetap seimbang sesuai dengan masukan yang diberikan. Robot segway memiliki titik berat yang berada di atas sumbu putar motor penggeraknya, sehingga menyebabkan sistem ini tidak akan stabil apabila diberi ganguan.

4 4 Tujuan penelitian Menerapkan algoritma fuzzy pada mikrokontroler AVR untuk menjaga kestabilan robot Memilik respons yang cepat terhadap perubahan kemiringan sudut elevasi

5 Robot Segway 5

6 Inverted Pendulum (1) 6

7 7 Inverted Pendulum (2) Stabil Condong Ke Kanan Condong Ke Kiri

8 8 Pengenalan logika fuzzy (1) Dr. Lotti A. Zadeh (1965) - Konsep ketidak pastian atau kesamaran - Penerapkan fuzzy pada pemrogram PC.

9 Pengenalan logika fuzzy (2) 9

10 10 Arsitekture logika fuzzy Untuk mendapatkan keluaran diperlukan 4 tahapan diantaranya : 1. Pembentukan himpunan fuzzy (fuzzyfikasi). 2. Aplikasi fungsi implikasi (fuzzy rules) 3. Komposisi aturan 4. Penegasan (defuzzyfikasi)

11 11 Spesifikasi Sistem Robot segway mini dapat menyeimbangkan dirinya secara otomatis tanpa bantuan gaya luar. sensor accelerometer MMA7260Q 3-axis sebagai sensor sudut keseimbangan. Kriteria seimbang : berosilasi antara -8 hingga 8 Robot segway mini dapat menyeimbangkan diri secara otomatis dengan gangguan sebesar sudut 5 derajat saja.

12 12 Perancangan Dan Implementasi Perancangan Perangkat Keras Desain Mekanik Desain Sistem elektronik Perancangan Perangkat Lunak Logika Fuzzy

13 13 Blok diagram Perancangan Sistem M i k r o k o n t r o l e r + L C D + K e y p a d Driver Motor Motor GearBox S e t p o i n t + - Sensor Accelerometer

14 14 Desain Mekanik 12.5 cm 2 cm 13 cm 8 cm 9 cm 18 cm Tampak atas Tampak Depan

15 Desain Mekanik 15

16 16 Desain Sistem Elektronik Catu Daya Regulator 5VDC ADC Accelerometer MMA7260Q Mikrokontroler DRIVER MOSFET Motor Kanan/Kiri LCD 2x16 ATMega32 Keypad Serial

17 Sistem Minimum 17

18 Driver Motor MOSFET 18

19 Sensor MMA7260Q 19

20 20 Perhitungan Sudut arctan A A x y

21 21 Perancangan Logika Fuzzy Fuzzy-PD Input error dan Delta Error (sudut) Output PWM r + - d dt e - + e Ke Ke Fuzzy Controller Ku u Robot Segway-Mini y Sensor Accelerometer

22 22 Fungsi Keanggotaan -Ѳ +Ѳ

23 23 Fungsi Keanggotaan Error (1) NB : error < -15⁰ NM : -15⁰ < error < -5 NK : -10⁰ < error < 0 Z : -5⁰ < error < 5 PK : 0⁰ < error < 10 PM : 5⁰ < error < 15 PB : error > 15

24 Degree of membership 24 Fungsi Keanggotaan Error (2) 1 NB NM NK ZERO PK PM PB ERROR

25 25 Fungsi Keanggotaan Delta Error (1) NB : delta_error < -15⁰ NM : -15⁰ < delta_error < -5 NK : -10⁰ < delta_error < 0 Z : -5⁰ < delta_error < 5 PK : 0⁰ < delta_error < 10 PM : 5⁰ < delta_error < 15 PB : delta_error > 15

26 Degree of membership 26 Fungsi Keanggotaan Delta Error (2) 1 NB NM NK ZERO PK PM PB DELTA-ERROR

27 27 Fungsi Keanggotaan PWM (1) NB :PWM< -21⁰ NM : -21⁰ < PWM < -7 NK : -14⁰ < PWM < 0 Z : -7⁰ < PWM < 7 PK : 0⁰ < PWM < 14 PM : 7⁰ < PWM < 21 PB : PWM > 21

28 Degree of membership 28 Fungsi Keanggotaan PWM (2) 1 NB NM NK ZERO PK PM PB PWM

29 29 Fuzzy Rule Penerapan rule - rule logika fuzzy, yaitu : 1. IF (e = NB) AND ( e = NB)THEN (PWM = NB) 2. IF (e = NB) AND ( e = NM) THEN (PWM = NB) 3. IF (e = NB) AND ( e = NS) THEN (PWM = NM) 4. IF (e = NB) AND ( e = Z) THEN (PWM = NM) IF (e = PB) AND ( e = Z) THEN (PWM = PM) 47 IF (e = PB) AND ( e = PS) THEN (PWM = PB) 48 IF (e = PB) AND ( e = PM )THEN (PWM = PB) 49 IF (e = PB) AND ( e = PB) THEN (PWM = PB)

30 30 Tabel Fuzzy Error NB NM NS Z PS PM PB NB NB NB NB NM NM NM Z NM NB NB NM NM NM Z PM Delta Error NS NB NM NM NK Z PM PM Z NM NM NK Z PK PM PM PS NM NM Z PK PM PM PB PM NM Z PM PM PM PB PB PB Z PM PM PM PB PB PB

31 31 Defuzzifikasi Metode rata- rata (Average) : u * : nilai keluaran k : harga maksimum u i : nilai keluaran maksimum ke-j µ i (u i ) : derajat keanggotaan elemenelemen pada u * k u i 1 k i 1 i * ( u ( u i ) i )

32 32 Diagram alir MULAI Timer 0 (Ts=1ms) Timer 1 (PWM) ADC 8 Bit Setpoint = 0 Error=0 Derror=0 Baca Parameter Ke, Ked, Ku Baca Sensor Hitung Error dan Delta-Error T Fuzzifikasi Inferensi Fuzzy Defuzzifikasi Keluarkan nilai hasil defuzzifikasi Untuk Menggerakan motor Tombol stop? Y Berhenti

33 33 Pengujian FLC Ke = 0.9 Ked = 0.7 Ku = 3

34 PWM Sudut (derajat) 34 Pengujian FLC (1) Respon Sudut Kemiringan Respon sudut Set point Waktu (milidetik) 100 grafik PWM terhadap waktu PWM Waktu (milidetik)

35 PWM Sudut (derajat) 35 Pengujian FLC (2) Respon Sudut Kemiringan Respons sudut Set Point Waktu (milidetik) grafik PWM terhadap waktu PWM Waktu (milidetik)

36 36 Video

37 37 Kesimpulan FLC dapat menstabilkan robot dengan sudut osilasi (-8) (+8) derajat Fungsi Keanggotaan Output PWM didapatkan dari Percobaan Parameter FLC K e = 0.9, K ed = 0.7, dan K u = 3 didapatkan dari hasil percobaan Desain mekanik, torsi motor dan kecepatan motor berpengaruh dalam kestabilan

38 Terima Kasih 38