L2E006058 Iswan Pradiptya
UNIVERSITAS DIPONEGORO
RANCANG BANGUN WAHANA TERBANG TANPA AWAK QUADROTOR
DENGAN SISTEM KENDALI KESTABILAN ORIENTASI ROLL DAN PITCH
TUGAS AKHIR
ISWAN PRADIPTYA
L2E 006 058
FAKULTAS TEKNIK
JURUSAN TEKNIK MESIN
SEMARANG
MARET 2011
i
ii
iii
iv
v
ABSTRAK
Wahana terbang tanpa awak dengan konfigurasi empat rotor merupakan
pengembangan dari teknologi Vertical Take-Off and Landing (VTOL) aircraft.
Penelitian ini difokuskan pada proses rancang bangun wahana terbang tanpa awak yang
disebut dengan quadrotor dengan sistem kontrol attitude. Perancangan sistem kendali
diawali dengan mengembangkan model dinamika dari sistem. Teknik kontrol
Proportional Integral Derivative (PID) diaplikasikan dengan data umpan balik yang
diperoleh dari sensor Inertial Measuring Unit (IMU) enam derajad kebebasan. Sistem
kendali attitude dikembangkan dalam dua mode kontrol, mode acro dan mode auto.
Dari hasil pengujian, nilai parameter proporsional (Kp) pada mode acro berada pada
nilai aman antara 0,5 hingga 0,85 dan nilai parameter diferensial (Kd) bisa diatur sesuai
dengan kemampuan pilot, yang secara signifikan mempengaruhi transient response
sistem. Nilai parameter PID mode auto cenderung lebih mudah dicari. Nilai Kp berada
pada nilai aman antara 2,5 hingga 4,5 dan nilai Kd secara signifikan menghilangkan
osilasi. Nilai optimal Kd dicapai pada 0,0065.
Kata kunci: Quadrotor, kontrol PID, attitude, IMU, VTOL
vi
ABSTRACT
Unmanned aerial vehicle (UAV) with four-rotor configuration is the development
of Vertical Take-Off and Landing (VTOL) technology. This research is focused on the
attitude control system design of the UAV called quadrotor. The design of the control
system was initiated with developing dynamics model of the system. Proportional
Integral Derivative (PID) control technique is applied with the feedback data obtained
from six degrees of freedom Inertial Measurement Unit (IMU) sensor. The attitude
control system is developed in two control modes, acro and auto mode. The
experimental results show that the proportional parameter (Kp) value in acro mode is
safe, ranging from 0.5 to 0.85 and differential parameter (Kd) value can be tuned in
accordance with the pilot’s ability, which significantly affect the transient response of
the system. The values of PID parameter in auto mode tend to be easier to tune than
acro mode. The value of Kp in auto mode is safe, ranging from 2.5 to 4.5 and the value
of Kd significantly eliminates the oscillation, the optimal value of Kd is reached at
0.0065.
key words : Quadrotor, PID control, attitude, IMU, VTOL
vii
HALAMAN PERSEMBAHAN
“Ku persembahkan untuk almarhum Ibu, Bapak dan Keluarga”
viii
KATA PENGANTAR
Puji syukur penulis panjatkan kehadirat Allah SWT, yang telah melimpahkan
rahmat dan karunia-Nya serta nikmat sehat sehingga tugas akhir yang merupakan tahap
akhir dari proses memperoleh gelar sarjana di Teknik Mesin Universitas Diponegoro ini
dapat terselesaikan.
Penyelesaian tugas akhir ini tidak lepas dari orang-orang yang telah membantu,
oleh karenanya, penulis mengucapkan terima kasih kepada:
1.
Bapak Dr. Susilo Adi Widyanto ST., MT., selaku pembimbing utama yang
telah begitu banyak memberikan bantuan, bimbingan, pengarahan serta
pengetahuan dalam pengerjaan dan penyelesaian tugas akhir ini.
2.
Bapak Muhammad Thoha, yang telah memberikan informasi dan saran
dalam menyelesaikan tugas akhir ini.
3.
Rekan Tugas Akhir Yuniawan Wijanarko dan teman-teman angkatan 2006
yang telah memberikan dorongan dan semangat sampai tugas akhir ini
selesai.
Penulis sadar banyak kekurangan dalam tugas akhir ini, maka dari itu besar
harapan untuk memberikan kritik maupun saran yang membangun. Semoga laporan
tugas akhir ini dapat bermanfaat bagi semua yang membaca.
Semarang, Maret 2011
Penulis
ix
DAFTAR ISI
HALAMAN JUDUL ........................................................................................
i
HALAMAN TUGAS SARJANA .....................................................................
ii
HALAMAN PERNYATAAN ORISINALITAS .............................................
iii
HALAMAN PENGESAHAN .........................................................................
iv
HALAMAN PERSETUJUAN PUBLIKASI ..................................................
v
ABSTRAK ......................................................................................................
vi
ABSTRACT ......................................................................................................
vii
HALAMAN PERSEMBAHAN .......................................................................
viii
KATA PENGANTAR ......................................................................................
ix
DAFTAR ISI ....................................................................................................
x
DAFTAR TABEL ............................................................................................
xiii
DAFTAR GAMBAR ........................................................................................
xiv
NOMENKLATUR ........................................................................................... xviii
BAB I PENDAHULUAN
1.1 Latar belakang .......................................................................................
1
1.2 Tujuan Penetian .....................................................................................
3
1.3 Batasan Masalah ....................................................................................
3
1.4 Metodologi Peneltian .............................................................................
4
1.5 Sistematika Penulisan ............................................................................
5
BAB II DASAR TEORI
2.1 Sejarah Perkembangan Helikopter .........................................................
6
2,1.1 Perkembangan Unmanned Aerial Vehicle (UAV) .........................
7
2.2 Konfigurasi Wahana Tak Berawak Skala Kecil ......................................
8
2.2.1 Perbandingan Helikopter dan Wahana Terbang Lainnya ...............
9
2.3 Dinamika Quadrotor UAV ....................................................................
13
2.4 Sistem Kontrol Proporsional Integral Derivatif ......................................
18
x
2.4.1 Kontroler Proporsional ..................................................................
20
2.4.2 Kontroler Integral ..........................................................................
21
2.4.3 Kontroler Diferensial ....................................................................
23
2.4.4 Kontroler PID ...............................................................................
25
2.4.5 Penalaan Parameter Kontrol PID ..................................................
26
2.5 Pemrograman Mikrokontroler ................................................................
30
2.5.1 Perangkat Lunak CodeVision AVR ..............................................
32
2.5.2 Sekilas Tentang Struktur Pemrograman Bahasa C .........................
35
2.6 Algorithma Sensor Fusion Untuk Estimasi Sudut Attitude ......................
39
2.6.1 Akselerometer ..............................................................................
40
2.6.2 Gyroscope ....................................................................................
45
2.6.3 Penggabungan Sensor Giroskop dan Akselerometer .....................
47
BAB III DESAIN DAN PEMBUATAN QUADROTOR
3.1 Desain dan Spesifikasi Perangkat Mekanik ............................................
54
3.1.1 Badan Utama Quadrotor ..............................................................
55
3.1.2 Motor DC Tanpa Sikat dan Propeler .............................................
59
3.2 Desain dan Spesifikasi Perangkat Keras Elektronik
Sistem Kontrol Tertanam .......................................................................
62
3.2.1 Mikrokontroler ATMega 16U .......................................................
65
3.2.2 Sensor Inertial Measuring Unit ....................................................
69
3.2.3 Sinyal Masukan Sistem Kontrol Quadrotor ..................................
77
3.2.4 Kontroler Kecepatan Elektronik Motor BLDC ..............................
81
3.2.5 Perangkat Antar Muka dengan Pengguna (User Interface) .............
83
3.3 Desain Piranti Lunak .............................................................................
86
3.3.1 Pengaturan Register untuk Proses Inisialisasi Mikrokontroler .......
88
3.3.2 Subrutin Program Pengukuran Lebar Pulsa receiver Futaba ..........
95
3.3.3 Subrutin Program Estimasi Sudut Euler untuk Attitude Angle .......
97
3.3.4 Implementasi Sistem Kontrol PID ................................................ 100
3.3.5 Desain Keluaran Sinyal PWM Motor ............................................ 104
xi
BAB IV PENGUJIAN DAN ANALISA KESTABILAN
4.1 Data Pengujian Gaya Angkat Rotor ....................................................... 107
4.2 Hasil Pengujian Respon Kontrol Kestabilan Attitude ............................. 111
4.2.1 Sistem Kontrol PID Mode Acro ..................................................... 112
4.2.2 Sistem Kontrol PID Mode Auto .................................................... 117
BAB V PENUTUP
6.1 Kesimpulan ............................................................................................ 123
6.2 Saran ...................................................................................................... 123
DAFTAR PUSTAKA
124
LAMPIRAN
xii
DAFTAR TABEL
Tabel 2.1 Perbandingan Beberapa Jenis Konfigurasi dan Prinsip Terbang
Wahana Terbang Tanpa Awak ........................................................
10
Tabel 2.2 Perbandingan Skala Nilai Konfigurasi Prinsip Terbang ...................
12
Tabel 2.3 Perbandingan Berbagai Konfigurasi dari VTOL ..............................
12
Tabel 2.4 Penalaan Paramater PID dengan Metode Kurva Reaksi ...................
28
Tabel 2.5 Penalaan Paramater PID dengan Metode Osilasi .............................
29
Tabel 2.6 Beberapa Compiler C untuk mikrokontroler AVR ...........................
32
Tabel 3.1 Perbedaan seri AVR berdasarkan kapasitas memori ........................
67
Tabel 3.2 Spesifikasi sensor ADXL335 ..........................................................
72
Tabel 3.3 Keterangan Fungsi pin sensor ADXL335 ........................................
72
Tabel 4.1 Data hasil pengujian gaya angkat .................................................... 108
xiii
DAFTAR GAMBAR
Gambar 2.1 Helical Air Screw, hasil rancangan Leonardo Da Vinci .................
6
Gambar 2.2 Gyroplane ....................................................................................
7
Gambar 2.3 Adaptive and Reflective Middleware System (ARMS) .....................
8
Gambar 2.4 Klasifikasi wahana udara tak berawak ..........................................
9
Gambar 2.5 Konsep konfigurasi kecepatan putar dari quadrotor, lebar anak panah
proporsional dengan besarnya kecepatan putar rotor .....................
14
Gambar 2.6 Kerangka acuan absolut pada bumi dan kerangka
acuan bodi quadrotor ....................................................................
15
Gambar 2.7 Sistem kontrol PID .......................................................................
19
Gambar 2.8 Diagram blok kontroler proporsional ............................................
20
Gambar 2.9 Proportional band dari kontroler proporsional
tergantung pada penguatan ............................................................
21
Gambar 2.10 Kurva sinyal kesalahan e(t) terhadap t dan kurva u(t) terhadap t pada
pembangkit kesalahan nol .............................................................
22
Gambar 2.11 Blok diagram hubungan antara besaran kesalahan dengan kontroller
integral .........................................................................................
22
Gambar 2.12 Perubahan keluaran sebagai akibat penguatan dan kesalahan ........
23
Gambar 2.13 Blok diagram kontroler diferensial ................................................
24
Gambar 2.14 Kurva waktu hubungan input-output kontroler diferensial ............
24
Gambar 2.15 Blok diagram kontroler PID ..........................................................
25
Gambar 2.16 Hubungan dalam fungsi waktu antara sinyal keluaran dengan masukan
untuk kontroller PID .....................................................................
26
Gambar 2.17 Kurva respons tangga satuan yang memperlihatkan 25 % lonjakan
maksimum ....................................................................................
27
Gambar 2.18 Respon tangga satuan sistem ........................................................
27
Gambar 2.19 Kurva Respons berbentuk S ..........................................................
28
Gambar 2.20 Sistem untaian tertutup dengan alat kontrol proporsional ..............
29
Gambar 2.21 Kurva respon sustain oscillation ...................................................
29
xiv
Gambar 2.22 Kurva respon quarter amplitude decay .........................................
30
Gambar 2.23 IDE perangkat lunak CodeVisionAVR versi 2.04.4a .....................
33
Gambar 2.24 Code Generator yang dapat digunakan untuk menginisialisasi registerregister pada mikrokontroler AVR ................................................
34
Gambar 2.25 Model ilustrasi akselerometer dalam ruang anti gravitasi ..............
40
Gambar 2.26 Model akselerometer yang diberi percepatan setara dengan 1g .....
41
Gambar 2.27 Model akselerometer yang diletakkan diatas permukaan bumi ......
41
Gambar 2.28 Model akselerometer yang dirotasi 45 derajad searah jarum jam ...
42
Gambar 2.29 Model kerangka acuan akselerometer tiga dimensi .......................
43
Gambar 2.30 Model vektor gaya pada akselerometer .........................................
44
Gambar 2.31 Model vektor tiga dimensi dari giroskop .......................................
45
Gambar 2.32 Arah orientasi data keluaran sensor ADXL335 .............................
47
Gambar 3.1 Badan utama quadrotor versi 1 .....................................................
55
Gambar 3.2 Badan utama quadrotor versi 2 .....................................................
56
Gambar 3.3 Konstruksi penjepit boom .............................................................
57
Gambar 3.4 Badan utama quadrotor versi 2 dengan pelindung
komponen elektronik ..................................................................
57
Gambar 3.5 Desain quadrotor versi 3 ..............................................................
58
Gambar 3.6 Quadrotor versi 4 .........................................................................
59
Gambar 3.7 Motor DC Brushless C2830-21 .....................................................
61
Gambar 3.8 Propeler GWS HD9050 CCW ......................................................
61
Gambar 3.9 Propeler GWS counter rotating HD9050 CW ...............................
62
Gambar 3.10 Desain perangkat keras quadrotor yang dikembangkan ................
65
Gambar 3.11 Konfigurasi Pin dari ATMEGA128 ..............................................
68
Gambar 3.12 Akselerometer ADXL335 .............................................................
71
Gambar 3.13 Blok diagram sensor ADXL335 ....................................................
71
Gambar 3.14 Konfigurasi pin sensor ADXL335 ................................................
72
Gambar 3.15 Sensor Gyroscope LPR530AL dan LPY530ALH .........................
74
Gambar 3.16 Blok diagram sensor LPR530AL ..................................................
75
Gambar 3.17 Konfigurasi kaki-kaki dan orientasi sensor LPR530AL .................
75
Gambar 3.18 Blok diagram LY530ALH ............................................................
76
xv
Gambar 3.19 Konfigurasi kaki-kaki sensor LY530ALH ....................................
76
Gambar 3.20 Subsistem sinyal masukan sistem kontrol .....................................
77
Gambar 3.21 Kontrol gerakan dengan Transmiter Futaba 2.4 Ghz .....................
78
Gambar 3.22 Sequence signal yang dihaslkan IC decoder Futaba enam jalur .....
80
Gambar 3.23 Mixing sinyal kontrol ....................................................................
81
Gambar 3.24 Esc E-Sky 25 A ............................................................................
82
Gambar 3.25 Perangkat pengendali kecepatan putaran motor .............................
83
Gambar 3.26 Perangkat K-125R ........................................................................
84
Gambar 3.27 GUI GyroScope 6 Channel ...........................................................
85
Gambar 3.28 GUI Iclin ......................................................................................
85
Gambar 3.29 WTM Monitor ..............................................................................
86
Gambar 3.30 Diagram alir sistem kontrol utama quadrotor ...............................
87
Gambar 3.31 CodeWizard AVR ........................................................................
88
Gambar 3.32 Diagram alir sistem kontrol PID mode acro .................................. 102
Gambar 3.33 Diagram alir fungsi sistem kontrol PID mode auto ....................... 103
Gambar 4.1 Pengujian gaya angkat rotor .......................................................... 107
Gambar 4.2 Grafik gaya angkat – PWM motor depan ...................................... 109
Gambar 4.3 Grafik gaya – PWM motor belakang ............................................. 109
Gambar 4.4 Grafik gaya angkat – PWM motor kanan ...................................... 110
Gambar 4.5 Grafik gaya angkat – PWM motor kiri .......................................... 110
Gambar 4.6 Grafik perbandingan gaya angkat keempat rotor ........................... 111
Gambar 4.7 Perangkat pengujian performa sistem control ................................ 112
Gambar 4.8 Kestabilan sudut roll pada kondisi hover pada mode kontrol acro.. 112
Gambar 4.9 Kontrol sudut roll quadrotor mode acro pada gerak ke kanan ....... 113
Gambar 4.10 Kontrol sudut roll quadrotor mode acro pada gerak ke kiri .......... 114
Gambar 4.11 Respon kotrol roll dengan gangguan gaya luar ............................. 114
Gambar 4.12 Kestabilan sudut pitch pada kondisi hover pada mode kontrol acro 115
Gambar 4.13 Kontrol sudut pitch quadrotor mode acro pada gerak maju .......... 116
Gambar 4.14 Kontrol sudut pitch quadrotor mode acro pada gerak mundur ...... 116
Gambar 4.15 Respon kotrol pitch dengan gangguan gaya luar ........................... 117
Gambar 4.16 Kestabilan sudut roll pada kondisi hover pada mode kontrol auto . 118
xvi
Gambar 4.17 Respon PID sudut roll mode auto dengan simpangan negative ..... 118
Gambar 4.18 Respon PID sudut roll mode auto dengan simpangan positif ......... 119
Gambar 4.19 Respon PID sudut roll dengan gangguan luar pada mode auto ...... 120
Gambar 4.20 Kestabilan sudut pitch pada kondisi hover pada mode kontrol auto 120
Gambar 4.21 Respon PID sudut pitch mode auto dengan simpangan positif ...... 121
Gambar 4.22 Respon PID sudut pitch mode auto dengan simpangan negatif ...... 122
Gambar 4.23 Respon PID sudut pitch mode auto dengan gangguan ................... 122
xvii
NOMENKLATUR
Simbol
Keterangan
Satuan
Nilai hasil konversi keluaran sensor akselerometer
sumbu x
Nilai hasil konversi keluaran sensor akselerometer
sumbu y
Nilai hasil konversi keluaran sensor akselerometer
sumbu z
Hasil konversi ADC sinyal giroskop pada sumbu Y
Hasil konversi ADC sinyal giroskop pada sumbu Z
Sudut vektor Rx terhadap vektor R
derajad
Sudut vektor Ry terhadap vektor R
derajad
Sudut vektor Rz terhadap vektor R
derajad
Faktor gaya dorong rotor
Cosinus sudut pitch
Cosinus sudut roll
Cosinus sudut yaw
( )
Sinyal keluaran sistem
d
Faktor drag
D
Suku derivatif
Kerangka inersia bumi
Kerangka inersia yang pada bodi quadrotor
( )
g
( )
Sinyal kesalahan
Gaya dorong rotor i
N
Percepatan gravitasi bumi
m/s2
Asumsi torsi giroskopik
N.m
I
Matrik diagonal
I
Suku Integral
xviii
Inersia quadrotor terhadap sumbu x
N.m.s2
Inersia quadrotor terhadap sumbu y
N.m.s2
Inersia quadrotor terhadap sumbu z
N.m.s2
Inersia rotor
N.m.s2
Nilai kalibrasi orientasi giroskop sumbu Y
Nilai kalibrasi orientasi giroskop sumbu X
Konstanta proporsional
Konstanta integral
Konstanta diferensial
K
Konstanta proporsional maksimum
L
Panjang lengan quadrotor
m
m
Massa quadrotor
kg
M
Torsi yang diaplikasikan pada quadrotor
N.m
Torsi giroskopik
N.m
( )
P
Sinyal kontroler
Suku proporsional
Pita proporsional
̈
dB
Matrik percepatan linier quadrotor
Transpose vektor posisi
R
Matriks rotasi
R
Vektor resultan akselerometer
g
R
Vektor akselerometer pada sumbu x
g
R
Vektor akselerometer pada sumbu y
g
proyeksi dari R vektor gaya inersia pada bidang XZ
proyeksi dari R vektor gaya inersia pada bidang YZ
Nilai Kecepatan sudut pitch hasil konversi sensor
derajad/detik
Nilai Kecepatan sudut roll hasil konversi sensor
derajad/detik
Nilai konversi sensor akselerometer pada sumbu x
g
Nilai konversi sensor akselerometer pada sumbu y
g
Nilai konversi sensor akselerometer pada sumbu z
g
xix
Nilai vektor sensor IMU terenstimasi pada sumbu x
g
Nilai vektor sensor IMU terenstimasi pada sumbu y
g
Nilai vektor sensor IMU terenstimasi pada sumbu z
g
Nilai vektor giroskop pada sumbu x
rad/s
Nilai vektor giroskop pada sumbu y
rad/s
Nilai vektor giroskop pada sumbu z
rad/s
Sinus sudut pitch
Sinus sudut roll
Sinus sudut yaw
t
waktu
detik
Gaya angkat total quadrotor
N
Parameter integral
Parameter diferensial
T
Waktu tunda
detik
T
Periode sinyal osilasi
detik
Kontrol Throttle
( )
V
Kontrol Roll
.
Kontrol Pitch
.
Kontrol Yaw
.
Sinyal masukan sistem
Vektor akselerometer pada sumbu z
g
Tegangan keluaran akselero pada keluaran sumbu x
volt
Tegangan keluaran akselero pada keluaran sumbu y
volt
Tegangan keluaran akselero pada keluaran sumbu z
volt
Tegangan referensi ADC
volt
Nilai tegangan offset akselerometer
volt
Nilai tegangan offset giroskop
volt
̈
Bobot kepercayaan terhadap giroskop
Percepatan linier pada sumbu x
xx
m/s2
̈
̈
̈
̇
̇
̈
̈
̇
Percepatan linier pada sumbu y
m/s2
Percepatan linier pada sumbu z
m/s2
Sudut roll
derajad
Percepatan sudut roll
rad/s2
Kecepatan sudut roll
rad/s
Sudut pitch
derajad
Kecepatan sudut pitch
rad/s
Percepatan sudut pitch
rad/s2
Sudut yaw
derajad
Kecepatan sudut yaw
rad/s
Percepatan sudut yaw
rad/s2
Transpose vektor rotasi
Kecepatan putaran rotor i
rad/s
Kecepatan putaran rotor 1
rad/s
Kecepatan putaran rotor 2
rad/s
Kecepatan putaran rotor 3
rad/s
Kecepatan putaran rotor 3
rad/s
xxi
RANCANG BANGUN WAHANA TERBANG TANPA AWAK QUADROTOR
DENGAN SISTEM KENDALI KESTABILAN ORIENTASI ROLL DAN PITCH
TUGAS AKHIR
ISWAN PRADIPTYA
L2E 006 058
FAKULTAS TEKNIK
JURUSAN TEKNIK MESIN
SEMARANG
MARET 2011
i
ii
iii
iv
v
ABSTRAK
Wahana terbang tanpa awak dengan konfigurasi empat rotor merupakan
pengembangan dari teknologi Vertical Take-Off and Landing (VTOL) aircraft.
Penelitian ini difokuskan pada proses rancang bangun wahana terbang tanpa awak yang
disebut dengan quadrotor dengan sistem kontrol attitude. Perancangan sistem kendali
diawali dengan mengembangkan model dinamika dari sistem. Teknik kontrol
Proportional Integral Derivative (PID) diaplikasikan dengan data umpan balik yang
diperoleh dari sensor Inertial Measuring Unit (IMU) enam derajad kebebasan. Sistem
kendali attitude dikembangkan dalam dua mode kontrol, mode acro dan mode auto.
Dari hasil pengujian, nilai parameter proporsional (Kp) pada mode acro berada pada
nilai aman antara 0,5 hingga 0,85 dan nilai parameter diferensial (Kd) bisa diatur sesuai
dengan kemampuan pilot, yang secara signifikan mempengaruhi transient response
sistem. Nilai parameter PID mode auto cenderung lebih mudah dicari. Nilai Kp berada
pada nilai aman antara 2,5 hingga 4,5 dan nilai Kd secara signifikan menghilangkan
osilasi. Nilai optimal Kd dicapai pada 0,0065.
Kata kunci: Quadrotor, kontrol PID, attitude, IMU, VTOL
vi
ABSTRACT
Unmanned aerial vehicle (UAV) with four-rotor configuration is the development
of Vertical Take-Off and Landing (VTOL) technology. This research is focused on the
attitude control system design of the UAV called quadrotor. The design of the control
system was initiated with developing dynamics model of the system. Proportional
Integral Derivative (PID) control technique is applied with the feedback data obtained
from six degrees of freedom Inertial Measurement Unit (IMU) sensor. The attitude
control system is developed in two control modes, acro and auto mode. The
experimental results show that the proportional parameter (Kp) value in acro mode is
safe, ranging from 0.5 to 0.85 and differential parameter (Kd) value can be tuned in
accordance with the pilot’s ability, which significantly affect the transient response of
the system. The values of PID parameter in auto mode tend to be easier to tune than
acro mode. The value of Kp in auto mode is safe, ranging from 2.5 to 4.5 and the value
of Kd significantly eliminates the oscillation, the optimal value of Kd is reached at
0.0065.
key words : Quadrotor, PID control, attitude, IMU, VTOL
vii
HALAMAN PERSEMBAHAN
“Ku persembahkan untuk almarhum Ibu, Bapak dan Keluarga”
viii
KATA PENGANTAR
Puji syukur penulis panjatkan kehadirat Allah SWT, yang telah melimpahkan
rahmat dan karunia-Nya serta nikmat sehat sehingga tugas akhir yang merupakan tahap
akhir dari proses memperoleh gelar sarjana di Teknik Mesin Universitas Diponegoro ini
dapat terselesaikan.
Penyelesaian tugas akhir ini tidak lepas dari orang-orang yang telah membantu,
oleh karenanya, penulis mengucapkan terima kasih kepada:
1.
Bapak Dr. Susilo Adi Widyanto ST., MT., selaku pembimbing utama yang
telah begitu banyak memberikan bantuan, bimbingan, pengarahan serta
pengetahuan dalam pengerjaan dan penyelesaian tugas akhir ini.
2.
Bapak Muhammad Thoha, yang telah memberikan informasi dan saran
dalam menyelesaikan tugas akhir ini.
3.
Rekan Tugas Akhir Yuniawan Wijanarko dan teman-teman angkatan 2006
yang telah memberikan dorongan dan semangat sampai tugas akhir ini
selesai.
Penulis sadar banyak kekurangan dalam tugas akhir ini, maka dari itu besar
harapan untuk memberikan kritik maupun saran yang membangun. Semoga laporan
tugas akhir ini dapat bermanfaat bagi semua yang membaca.
Semarang, Maret 2011
Penulis
ix
DAFTAR ISI
HALAMAN JUDUL ........................................................................................
i
HALAMAN TUGAS SARJANA .....................................................................
ii
HALAMAN PERNYATAAN ORISINALITAS .............................................
iii
HALAMAN PENGESAHAN .........................................................................
iv
HALAMAN PERSETUJUAN PUBLIKASI ..................................................
v
ABSTRAK ......................................................................................................
vi
ABSTRACT ......................................................................................................
vii
HALAMAN PERSEMBAHAN .......................................................................
viii
KATA PENGANTAR ......................................................................................
ix
DAFTAR ISI ....................................................................................................
x
DAFTAR TABEL ............................................................................................
xiii
DAFTAR GAMBAR ........................................................................................
xiv
NOMENKLATUR ........................................................................................... xviii
BAB I PENDAHULUAN
1.1 Latar belakang .......................................................................................
1
1.2 Tujuan Penetian .....................................................................................
3
1.3 Batasan Masalah ....................................................................................
3
1.4 Metodologi Peneltian .............................................................................
4
1.5 Sistematika Penulisan ............................................................................
5
BAB II DASAR TEORI
2.1 Sejarah Perkembangan Helikopter .........................................................
6
2,1.1 Perkembangan Unmanned Aerial Vehicle (UAV) .........................
7
2.2 Konfigurasi Wahana Tak Berawak Skala Kecil ......................................
8
2.2.1 Perbandingan Helikopter dan Wahana Terbang Lainnya ...............
9
2.3 Dinamika Quadrotor UAV ....................................................................
13
2.4 Sistem Kontrol Proporsional Integral Derivatif ......................................
18
x
2.4.1 Kontroler Proporsional ..................................................................
20
2.4.2 Kontroler Integral ..........................................................................
21
2.4.3 Kontroler Diferensial ....................................................................
23
2.4.4 Kontroler PID ...............................................................................
25
2.4.5 Penalaan Parameter Kontrol PID ..................................................
26
2.5 Pemrograman Mikrokontroler ................................................................
30
2.5.1 Perangkat Lunak CodeVision AVR ..............................................
32
2.5.2 Sekilas Tentang Struktur Pemrograman Bahasa C .........................
35
2.6 Algorithma Sensor Fusion Untuk Estimasi Sudut Attitude ......................
39
2.6.1 Akselerometer ..............................................................................
40
2.6.2 Gyroscope ....................................................................................
45
2.6.3 Penggabungan Sensor Giroskop dan Akselerometer .....................
47
BAB III DESAIN DAN PEMBUATAN QUADROTOR
3.1 Desain dan Spesifikasi Perangkat Mekanik ............................................
54
3.1.1 Badan Utama Quadrotor ..............................................................
55
3.1.2 Motor DC Tanpa Sikat dan Propeler .............................................
59
3.2 Desain dan Spesifikasi Perangkat Keras Elektronik
Sistem Kontrol Tertanam .......................................................................
62
3.2.1 Mikrokontroler ATMega 16U .......................................................
65
3.2.2 Sensor Inertial Measuring Unit ....................................................
69
3.2.3 Sinyal Masukan Sistem Kontrol Quadrotor ..................................
77
3.2.4 Kontroler Kecepatan Elektronik Motor BLDC ..............................
81
3.2.5 Perangkat Antar Muka dengan Pengguna (User Interface) .............
83
3.3 Desain Piranti Lunak .............................................................................
86
3.3.1 Pengaturan Register untuk Proses Inisialisasi Mikrokontroler .......
88
3.3.2 Subrutin Program Pengukuran Lebar Pulsa receiver Futaba ..........
95
3.3.3 Subrutin Program Estimasi Sudut Euler untuk Attitude Angle .......
97
3.3.4 Implementasi Sistem Kontrol PID ................................................ 100
3.3.5 Desain Keluaran Sinyal PWM Motor ............................................ 104
xi
BAB IV PENGUJIAN DAN ANALISA KESTABILAN
4.1 Data Pengujian Gaya Angkat Rotor ....................................................... 107
4.2 Hasil Pengujian Respon Kontrol Kestabilan Attitude ............................. 111
4.2.1 Sistem Kontrol PID Mode Acro ..................................................... 112
4.2.2 Sistem Kontrol PID Mode Auto .................................................... 117
BAB V PENUTUP
6.1 Kesimpulan ............................................................................................ 123
6.2 Saran ...................................................................................................... 123
DAFTAR PUSTAKA
124
LAMPIRAN
xii
DAFTAR TABEL
Tabel 2.1 Perbandingan Beberapa Jenis Konfigurasi dan Prinsip Terbang
Wahana Terbang Tanpa Awak ........................................................
10
Tabel 2.2 Perbandingan Skala Nilai Konfigurasi Prinsip Terbang ...................
12
Tabel 2.3 Perbandingan Berbagai Konfigurasi dari VTOL ..............................
12
Tabel 2.4 Penalaan Paramater PID dengan Metode Kurva Reaksi ...................
28
Tabel 2.5 Penalaan Paramater PID dengan Metode Osilasi .............................
29
Tabel 2.6 Beberapa Compiler C untuk mikrokontroler AVR ...........................
32
Tabel 3.1 Perbedaan seri AVR berdasarkan kapasitas memori ........................
67
Tabel 3.2 Spesifikasi sensor ADXL335 ..........................................................
72
Tabel 3.3 Keterangan Fungsi pin sensor ADXL335 ........................................
72
Tabel 4.1 Data hasil pengujian gaya angkat .................................................... 108
xiii
DAFTAR GAMBAR
Gambar 2.1 Helical Air Screw, hasil rancangan Leonardo Da Vinci .................
6
Gambar 2.2 Gyroplane ....................................................................................
7
Gambar 2.3 Adaptive and Reflective Middleware System (ARMS) .....................
8
Gambar 2.4 Klasifikasi wahana udara tak berawak ..........................................
9
Gambar 2.5 Konsep konfigurasi kecepatan putar dari quadrotor, lebar anak panah
proporsional dengan besarnya kecepatan putar rotor .....................
14
Gambar 2.6 Kerangka acuan absolut pada bumi dan kerangka
acuan bodi quadrotor ....................................................................
15
Gambar 2.7 Sistem kontrol PID .......................................................................
19
Gambar 2.8 Diagram blok kontroler proporsional ............................................
20
Gambar 2.9 Proportional band dari kontroler proporsional
tergantung pada penguatan ............................................................
21
Gambar 2.10 Kurva sinyal kesalahan e(t) terhadap t dan kurva u(t) terhadap t pada
pembangkit kesalahan nol .............................................................
22
Gambar 2.11 Blok diagram hubungan antara besaran kesalahan dengan kontroller
integral .........................................................................................
22
Gambar 2.12 Perubahan keluaran sebagai akibat penguatan dan kesalahan ........
23
Gambar 2.13 Blok diagram kontroler diferensial ................................................
24
Gambar 2.14 Kurva waktu hubungan input-output kontroler diferensial ............
24
Gambar 2.15 Blok diagram kontroler PID ..........................................................
25
Gambar 2.16 Hubungan dalam fungsi waktu antara sinyal keluaran dengan masukan
untuk kontroller PID .....................................................................
26
Gambar 2.17 Kurva respons tangga satuan yang memperlihatkan 25 % lonjakan
maksimum ....................................................................................
27
Gambar 2.18 Respon tangga satuan sistem ........................................................
27
Gambar 2.19 Kurva Respons berbentuk S ..........................................................
28
Gambar 2.20 Sistem untaian tertutup dengan alat kontrol proporsional ..............
29
Gambar 2.21 Kurva respon sustain oscillation ...................................................
29
xiv
Gambar 2.22 Kurva respon quarter amplitude decay .........................................
30
Gambar 2.23 IDE perangkat lunak CodeVisionAVR versi 2.04.4a .....................
33
Gambar 2.24 Code Generator yang dapat digunakan untuk menginisialisasi registerregister pada mikrokontroler AVR ................................................
34
Gambar 2.25 Model ilustrasi akselerometer dalam ruang anti gravitasi ..............
40
Gambar 2.26 Model akselerometer yang diberi percepatan setara dengan 1g .....
41
Gambar 2.27 Model akselerometer yang diletakkan diatas permukaan bumi ......
41
Gambar 2.28 Model akselerometer yang dirotasi 45 derajad searah jarum jam ...
42
Gambar 2.29 Model kerangka acuan akselerometer tiga dimensi .......................
43
Gambar 2.30 Model vektor gaya pada akselerometer .........................................
44
Gambar 2.31 Model vektor tiga dimensi dari giroskop .......................................
45
Gambar 2.32 Arah orientasi data keluaran sensor ADXL335 .............................
47
Gambar 3.1 Badan utama quadrotor versi 1 .....................................................
55
Gambar 3.2 Badan utama quadrotor versi 2 .....................................................
56
Gambar 3.3 Konstruksi penjepit boom .............................................................
57
Gambar 3.4 Badan utama quadrotor versi 2 dengan pelindung
komponen elektronik ..................................................................
57
Gambar 3.5 Desain quadrotor versi 3 ..............................................................
58
Gambar 3.6 Quadrotor versi 4 .........................................................................
59
Gambar 3.7 Motor DC Brushless C2830-21 .....................................................
61
Gambar 3.8 Propeler GWS HD9050 CCW ......................................................
61
Gambar 3.9 Propeler GWS counter rotating HD9050 CW ...............................
62
Gambar 3.10 Desain perangkat keras quadrotor yang dikembangkan ................
65
Gambar 3.11 Konfigurasi Pin dari ATMEGA128 ..............................................
68
Gambar 3.12 Akselerometer ADXL335 .............................................................
71
Gambar 3.13 Blok diagram sensor ADXL335 ....................................................
71
Gambar 3.14 Konfigurasi pin sensor ADXL335 ................................................
72
Gambar 3.15 Sensor Gyroscope LPR530AL dan LPY530ALH .........................
74
Gambar 3.16 Blok diagram sensor LPR530AL ..................................................
75
Gambar 3.17 Konfigurasi kaki-kaki dan orientasi sensor LPR530AL .................
75
Gambar 3.18 Blok diagram LY530ALH ............................................................
76
xv
Gambar 3.19 Konfigurasi kaki-kaki sensor LY530ALH ....................................
76
Gambar 3.20 Subsistem sinyal masukan sistem kontrol .....................................
77
Gambar 3.21 Kontrol gerakan dengan Transmiter Futaba 2.4 Ghz .....................
78
Gambar 3.22 Sequence signal yang dihaslkan IC decoder Futaba enam jalur .....
80
Gambar 3.23 Mixing sinyal kontrol ....................................................................
81
Gambar 3.24 Esc E-Sky 25 A ............................................................................
82
Gambar 3.25 Perangkat pengendali kecepatan putaran motor .............................
83
Gambar 3.26 Perangkat K-125R ........................................................................
84
Gambar 3.27 GUI GyroScope 6 Channel ...........................................................
85
Gambar 3.28 GUI Iclin ......................................................................................
85
Gambar 3.29 WTM Monitor ..............................................................................
86
Gambar 3.30 Diagram alir sistem kontrol utama quadrotor ...............................
87
Gambar 3.31 CodeWizard AVR ........................................................................
88
Gambar 3.32 Diagram alir sistem kontrol PID mode acro .................................. 102
Gambar 3.33 Diagram alir fungsi sistem kontrol PID mode auto ....................... 103
Gambar 4.1 Pengujian gaya angkat rotor .......................................................... 107
Gambar 4.2 Grafik gaya angkat – PWM motor depan ...................................... 109
Gambar 4.3 Grafik gaya – PWM motor belakang ............................................. 109
Gambar 4.4 Grafik gaya angkat – PWM motor kanan ...................................... 110
Gambar 4.5 Grafik gaya angkat – PWM motor kiri .......................................... 110
Gambar 4.6 Grafik perbandingan gaya angkat keempat rotor ........................... 111
Gambar 4.7 Perangkat pengujian performa sistem control ................................ 112
Gambar 4.8 Kestabilan sudut roll pada kondisi hover pada mode kontrol acro.. 112
Gambar 4.9 Kontrol sudut roll quadrotor mode acro pada gerak ke kanan ....... 113
Gambar 4.10 Kontrol sudut roll quadrotor mode acro pada gerak ke kiri .......... 114
Gambar 4.11 Respon kotrol roll dengan gangguan gaya luar ............................. 114
Gambar 4.12 Kestabilan sudut pitch pada kondisi hover pada mode kontrol acro 115
Gambar 4.13 Kontrol sudut pitch quadrotor mode acro pada gerak maju .......... 116
Gambar 4.14 Kontrol sudut pitch quadrotor mode acro pada gerak mundur ...... 116
Gambar 4.15 Respon kotrol pitch dengan gangguan gaya luar ........................... 117
Gambar 4.16 Kestabilan sudut roll pada kondisi hover pada mode kontrol auto . 118
xvi
Gambar 4.17 Respon PID sudut roll mode auto dengan simpangan negative ..... 118
Gambar 4.18 Respon PID sudut roll mode auto dengan simpangan positif ......... 119
Gambar 4.19 Respon PID sudut roll dengan gangguan luar pada mode auto ...... 120
Gambar 4.20 Kestabilan sudut pitch pada kondisi hover pada mode kontrol auto 120
Gambar 4.21 Respon PID sudut pitch mode auto dengan simpangan positif ...... 121
Gambar 4.22 Respon PID sudut pitch mode auto dengan simpangan negatif ...... 122
Gambar 4.23 Respon PID sudut pitch mode auto dengan gangguan ................... 122
xvii
NOMENKLATUR
Simbol
Keterangan
Satuan
Nilai hasil konversi keluaran sensor akselerometer
sumbu x
Nilai hasil konversi keluaran sensor akselerometer
sumbu y
Nilai hasil konversi keluaran sensor akselerometer
sumbu z
Hasil konversi ADC sinyal giroskop pada sumbu Y
Hasil konversi ADC sinyal giroskop pada sumbu Z
Sudut vektor Rx terhadap vektor R
derajad
Sudut vektor Ry terhadap vektor R
derajad
Sudut vektor Rz terhadap vektor R
derajad
Faktor gaya dorong rotor
Cosinus sudut pitch
Cosinus sudut roll
Cosinus sudut yaw
( )
Sinyal keluaran sistem
d
Faktor drag
D
Suku derivatif
Kerangka inersia bumi
Kerangka inersia yang pada bodi quadrotor
( )
g
( )
Sinyal kesalahan
Gaya dorong rotor i
N
Percepatan gravitasi bumi
m/s2
Asumsi torsi giroskopik
N.m
I
Matrik diagonal
I
Suku Integral
xviii
Inersia quadrotor terhadap sumbu x
N.m.s2
Inersia quadrotor terhadap sumbu y
N.m.s2
Inersia quadrotor terhadap sumbu z
N.m.s2
Inersia rotor
N.m.s2
Nilai kalibrasi orientasi giroskop sumbu Y
Nilai kalibrasi orientasi giroskop sumbu X
Konstanta proporsional
Konstanta integral
Konstanta diferensial
K
Konstanta proporsional maksimum
L
Panjang lengan quadrotor
m
m
Massa quadrotor
kg
M
Torsi yang diaplikasikan pada quadrotor
N.m
Torsi giroskopik
N.m
( )
P
Sinyal kontroler
Suku proporsional
Pita proporsional
̈
dB
Matrik percepatan linier quadrotor
Transpose vektor posisi
R
Matriks rotasi
R
Vektor resultan akselerometer
g
R
Vektor akselerometer pada sumbu x
g
R
Vektor akselerometer pada sumbu y
g
proyeksi dari R vektor gaya inersia pada bidang XZ
proyeksi dari R vektor gaya inersia pada bidang YZ
Nilai Kecepatan sudut pitch hasil konversi sensor
derajad/detik
Nilai Kecepatan sudut roll hasil konversi sensor
derajad/detik
Nilai konversi sensor akselerometer pada sumbu x
g
Nilai konversi sensor akselerometer pada sumbu y
g
Nilai konversi sensor akselerometer pada sumbu z
g
xix
Nilai vektor sensor IMU terenstimasi pada sumbu x
g
Nilai vektor sensor IMU terenstimasi pada sumbu y
g
Nilai vektor sensor IMU terenstimasi pada sumbu z
g
Nilai vektor giroskop pada sumbu x
rad/s
Nilai vektor giroskop pada sumbu y
rad/s
Nilai vektor giroskop pada sumbu z
rad/s
Sinus sudut pitch
Sinus sudut roll
Sinus sudut yaw
t
waktu
detik
Gaya angkat total quadrotor
N
Parameter integral
Parameter diferensial
T
Waktu tunda
detik
T
Periode sinyal osilasi
detik
Kontrol Throttle
( )
V
Kontrol Roll
.
Kontrol Pitch
.
Kontrol Yaw
.
Sinyal masukan sistem
Vektor akselerometer pada sumbu z
g
Tegangan keluaran akselero pada keluaran sumbu x
volt
Tegangan keluaran akselero pada keluaran sumbu y
volt
Tegangan keluaran akselero pada keluaran sumbu z
volt
Tegangan referensi ADC
volt
Nilai tegangan offset akselerometer
volt
Nilai tegangan offset giroskop
volt
̈
Bobot kepercayaan terhadap giroskop
Percepatan linier pada sumbu x
xx
m/s2
̈
̈
̈
̇
̇
̈
̈
̇
Percepatan linier pada sumbu y
m/s2
Percepatan linier pada sumbu z
m/s2
Sudut roll
derajad
Percepatan sudut roll
rad/s2
Kecepatan sudut roll
rad/s
Sudut pitch
derajad
Kecepatan sudut pitch
rad/s
Percepatan sudut pitch
rad/s2
Sudut yaw
derajad
Kecepatan sudut yaw
rad/s
Percepatan sudut yaw
rad/s2
Transpose vektor rotasi
Kecepatan putaran rotor i
rad/s
Kecepatan putaran rotor 1
rad/s
Kecepatan putaran rotor 2
rad/s
Kecepatan putaran rotor 3
rad/s
Kecepatan putaran rotor 3
rad/s
xxi