TUGAS AKHIR
Diajukan Sebagai Salah Satu Syarat Untuk Menyelesaikan Studi Jenjang Program
Diploma Tiga
Oleh :
Nama NIM
Triyadi Zafarudin (16040241)
Eko Noval Andriani (16040245)
Muhammad Faisal Firdaus (16040244)
i
ii
iii
iv
v
MOTTO
Jika kita tidak ingin belajar maka tak seorangpun akan menolong
Di era serba cepat ini, ada sesuatu yang lebih berharga daripada
vi
HALAMAN PERSEMBAHAN
vii
ABSTRAK
Kata Kunci : Arduino Uno, Bluetooth, MIT App Inventor, Servo, Smartphone
Andoid.
viii
KATA PENGANTAR
ix
DAFTAR ISI
Halaman
HALAMAN JUDUL ................................................................................................ i
HALAMAN PERYATAAN KEASLIAN .............................................................. ii
HALAMAN PERNYATAAN PERSETUJUAN PUBLIKASI ............................. iii
HALAMAN PERSETUJUAN ............................................................................... iv
HALAMAN PENGESAHAN ................................................................................. v
MOTTO .................................................................................................................. vi
HALAMAN PERSEMBAHAN ............................................................................ vii
ABSTRAK ........................................................................................................... viii
KATA PENGANTAR............................................................................................ ix
DAFTAR ISI ........................................................................................................... x
DAFTAR TABEL ................................................................................................. xii
DAFTAR LAMPIRAN ........................................................................................ xiv
BAB I PENDAHULUAN ....................................................................................... 1
1.1 Latar Belakang ............................................................................................... 1
1.2 Rumusan Masalah .......................................................................................... 4
1.3 Batasan Masalah ............................................................................................ 4
1.4 Tujuan ............................................................................................................ 5
1.5 Manfaat .......................................................................................................... 5
1.6 Sistematika Penulisan .................................................................................... 6
BAB II TINJAUAN PUSTAKA ............................................................................. 8
2.1 Penelitian Terkait ........................................................................................... 8
2.2 Landasan Teori ............................................................................................ 10
BAB III METODOLOGI PENELITIAN .............................................................. 22
3.1 Perencanaan ................................................................................................. 22
3.2 Analisis ........................................................................................................ 22
3.3 Rancangan atau Desain ................................................................................ 23
3.4 Implementasi................................................................................................ 23
x
3.5 Metode Pengumpulan Data.......................................................................... 24
3.5.1 Observasi ............................................................................................ 24
3.5.2 Wawancara.......................................................................................... 24
3.5.3 Studi Literatur ..................................................................................... 25
BAB IV ANALISA DAN PERANCANGAN SISTEM ....................................... 28
4.1 Analisa Permasalahan .................................................................................. 28
4.2 Analisa Kebutuhan Sistem........................................................................... 28
4.3 Perancangan Sistem ..................................................................................... 30
4.3.1 Diagram Blok ...................................................................................... 30
4.3.2 Diagram Alir ( Flowchart) .................................................................. 32
BAB V IMPLEMENTASI SISTEM ..................................................................... 36
5.1 Implementasi................................................................................................ 36
5.2 Tahap Instalasi ............................................................................................. 36
5.2.1 Perancangan ........................................................................................ 37
5.2.2 Pembuatan ........................................................................................... 38
5.2.3 Perakitan ............................................................................................. 44
5.3 Uji Coba dan hasil pengujian....................................................................... 47
5.3.1 Uji Coba .............................................................................................. 47
BAB VI PENUTUP .............................................................................................. 51
6.1 Kesimpulan .................................................................................................. 51
6.2 Saran ............................................................................................................ 51
DAFTAR PUSTAKA ........................................................................................... 53
xi
DAFTAR TABEL
Halaman
Tabel 2.1 Spesifikasi Arduino Uno ....................................................................... 13
Tabel 2.2 Bluetooth hc-05 ..................................................................................... 15
Tabel 2.3 Spesifikasi Servo Mg90s ....................................................................... 16
Tabel 2.4 Spesifikasi Kamera................................................................................ 17
Tabel 2.5 Spesifikasi Bateray Lippo ..................................................................... 19
Tabel 2.6 Spesifikasi Modul Charger Lippo ......................................................... 20
Tabel 2.7 Studi Literatur ....................................................................................... 25
Tabel 2.8 Simbol dan keterangan flowchart.......................................................... 34
Tabel 2.9 RancanganAnggaran Biaya…………………………………................34
xii
DAFTAR GAMBAR
Halaman
Gambar 2.1 : Tampilan Arduino IDE.................................................................... 11
Gambar 2.2 : Tampilan App Inventor ................................................................... 12
Gambar 2.3 : Arduino Uno .................................................................................... 13
Gambar 2.4 : Bluetooth Hc-05 .............................................................................. 14
Gambar 2.5 : Servo Mg90s ................................................................................... 16
Gambar 2.6 : Kamera ............................................................................................ 17
Gambar 2.7 : Saklar ............................................................................................... 18
Gambar 2.8 : Sensor Shield V5.0 .......................................................................... 19
Gambar 2.9 : Modul Charger Lippo ...................................................................... 20
Gambar 2.10 : Bateray Lippo ................................................................................ 21
Gambar 4.1 : Diagram Blok .................................................................................. 30
Gambar 4.2 : Flowchart Alir Robot dan Android ................................................. 32
Gambar 4.3 : Flowchart Alir Robot Quadruped .................................................... 33
Gambar 5.1 : Proses Upload Script ke Arduino Uno ............................................ 39
Gambar 5.2 : Pembuatan Aplikasi Android .......................................................... 40
Gambar 5.3 : Pembuatan Blok Aplikasi Android ................................................. 42
Gambar 5.4 : Pembuatan Icon ............................................................................... 43
Gambar 5.5 : Aplikasi Kontrol Android................................................................ 44
Gambar 5.6 : Perkitan Robot Bahan Akrlik .......................................................... 45
Gambar 5.7 : Perakitan Komponen Alat Robot .................................................... 46
xiii
DAFTAR LAMPIRAN
Halaman
Lampiran Proses Pembuatan Produk................................................................... A-1
Lampiran Surat Pembimbing TA ........................................................................ B-1
Lampiran Source Code ........................................................................................ C-1
xiv
BAB I
PENDAHULUAN
robotik, agar SDM Indonesia memiliki daya saing dengan negara lain. Perlu
cepat. salah satunya teknologi robot (Quadruped). Salah satu jenis robot itu
segi empat sama sisi sehingga jalannya lebih akurat. Dengan menggunakan
desain ini jika robot berhadapan dengan jalan yang terjal, robot tidak perlu
lagi memutar badan seperti robot berkaki enam. Pola gerak yang digunakan
pada robot berkaki empat adalah trot gait. Trot adalah pola gerak yang
menggunakan dua kaki pada posisi diagonal sebagai kaki transisi, sedangkan
dua kaki yang lainnya sebagai kaki penopang, untuk menjaga keseimbangan
selagi kaki transisi sedang melangkah. Dari hasil penelitian yang telah
1
2
mampu menyeimbangkan badan pada saat maju, belok kanan dan belok kiri.
Salah satu kekurangan atau pengembangan yang belum ada pada robot
sehingga saat robot berjalan di ruangan yang sempit dan dihadapkan dengan
ruangan yang gelap seperti goa/trowongan masih belum bisa memilih jalur yg
bisa dilalui.
kamera Action Cam. Action Cam adalah sebuah kamera yang dirancang
yang nantinya akan memanfaatkan gelombang Ghz atau jaringan wifi supaya
Wi-Fi. Sistem ini merupakan sistem aplikasi monitoring dan kontrol jarak
bencana alam gempa bumi. Bencana gempa bumi jika terjadi dengan
pengintai yang mampu untuk masuk ke daerah yang sulit untuk dijangkau
runtuhnya gedung-gedung kantor atau mall, yang mana ketahui bahwa kedua
pengintai yang dibuat dan bisa membantu proses pengevakuasian, dalam hal
ini pada kejadian bencana gempa bumi, robot-robot tersebut juga memiliki
robot yang serupa. Robot yang dapat dikendalikan untuk masuk dan melihat
ke daerah reruntuhan akibat gempa. Jenis robot yang akan dibuat adalah robot
uraian diatas, dapat diambil judul untuk penelitian Tugas akhir ini yaitu ”
sebagai berikut :
dengan menambahkan komponen baru dalam hal ini adalah Action Cam ?
2. Penambahan alat apa yang akan digunakan pada robot quadruped, supaya
dapat memonitoring ?
android ?
Agar tidak meluas dari maksud penelitian ini, maka permasalahannya dibatasi
sebagai berikut :
1.4 Tujuan
kamera agar dapat dijalankan tanpa takut robot terjebak pada jalur yang
1.5 Manfaat
Tegal.
Laporan Tugas Akhir ini terdiri dari enam bab dengan penulisan sebagai
berikut :
BAB I PENDAHULUAN
tugas akhir.
yang dilakukan.
(walking robot) merupakan salah satu penelitian bidang robotika yang paling
selama beberapa tahun terakhir. Secara umum, robot berjalan terbagi menjadi
dua kelompok, yaitu robot berkaki dan robot beroda. Robot berkaki
atas permukaan yang relatif kasar karena robot berkaki tidak memerlukan
metode yang ditanamkan dalam proses kendali robot dan hanya dapat
8
9
Systems and kontrol” oleh Meryana Eka Fajarwati dkk (2017) .Menggunakan
teknik trot gait yang hanya menggunakan empat kaki dimana tiap kakinya
menggunakan dua servo maka di dapatkan hasil yang cukup maksimal. Robot
dapat berbelok kanan dan belok kiri dengan seimbang sesuai dengan
algoritma program yang telah dibuat. Sistem gerak robot yang menggunakan
diberikan.
Dwi Saputro dkk (2018) . Dalam proses penelitian mulai dari perancangan
sebuah sistem yang saling terhubung dan berjalan secara squencial atau
berurutan mulai dari akuisisi data sensor jarak, pengolahan data sampai
sensor HC-SR04 dan pengolahan data memiliki hasil sangat baik. Akurasi
pembacaan sensor dalam sistem ini sangatlah baik dengan persentase error
0%. Waktu eksekusi dan tingkat prioritas dalam menjalankan task pada
sistem ini juga baik, waktu eksekusi tidak melebihi dari waktu yang
umum robot dibagi menjadi beberapa bagian yaitu robot manipulator, robot
mobil (mobile robot), robot daratan yang terbagi atas robot berkaki dan
beroda, robot air (submarine robot) dan robot terbang (aerial robot), (Amelia,
penggerak utamanya.
Quadruped :
dengan mikrokontroler.
11
juga dilengkapi dengan library C/C++ yang biasa disebut Wiring yang
membuat operasi input dan output menjadi lebih mudah. Arduino IDE ini
berbasis teks menjadi berbasis visual (drag and drop) berbentuk blok-
2018). Dan sampai saat ini arduino uno masih digunakan Seperti yang
akan dibuat Robot quadruped. Berikut gambar Arduino Uno pada foto
2.3
13
Berikut adalah spesifikasi teknis dari Arduino UNO pada tabel 2.1
1. Microcontroller ATmega328P
2. Operating Voltage 5V
pengendalian manual mobile robot via android (fathur 2016). Dan saat ini
Berikut adalah spesifikasi teknis dari Bluetooth hc-05 pada tabel 2.2
4. Kontrol PIO
5. Vin DC DC 5V
6. Arus 30 mA (max)
berkaki empat pada robot lizard. dengan memakai servo delapan yang
Uno dengan 8 servo mg 90s. Berikut gambar Servo mg 90s pada foto 2.5
16
Berikut adalah spesifikasi teknis dari Servo Mg90s pada tabel 2.3 :
6. Dimensi 23x12x29 mm
2.2.6 Kamera
dalam air. Dengan ukuran kamera yang kecil dan biasa digunakan
17
1. Adapter 5V/ 1A
2.2.7 Saklar NC
hidupkan dengan cara menekan push button hijau, maka relay akan aktif.
lampu rumah dan alarm akan berubah ke posisi 1 atau aktif. Maka pada
penelitian ini menggunakan Saklar NC. Berikut gambar Saklar pada foto
2.7
Bateray Lippo. Berikut gambar Modul Charger Lippo pada foto 2.9
20
Berikut adalah spesifikasi teknis dari Modul Charger Lippo pada tabel
2.5
6. Perlindungan arus 3A
berlebih
2.10
Berikut adalah spesifikasi teknis dari Bateray Lippo pada tabel 2.6
1. Kapasitas 950mAh
2. Volt 1S / 3.7V
METODOLOGI PENELITIAN
1. Perencanaan
Uno yang akan dilakukan, menyiapkan seluruh data yang dibutuhkan untuk
membuat robot berkaki agar bisa berjalan di jalur yang tidak rata atau terjal.
2. Analisis
22
23
a. Perancangan Hardware
b. Perancangan Software
1. MIT Inventor
2. Arduino IDE.
3. Photoscape
4. Fritzing
4. Implementasi
kontrol android ini akan dilakukan di medan yang tidak rata atau terjal
3.1 Observasi
05, kota tegal, jawa tengah, tembok yang roboh berada di sisi sebelah
meter dibangun pada tahun 2005 dan roboh pada tanggal 23 september
2015 pada waktu kurang lebih jam 09.00 WIB, yang memakan
korban 1 orang tewas dan lainnya luka luka. Dengan medan yang
3.2 Wawancara
saksi yang bernama Bapak zam yang pada saat kejadiaan ada disekitar
sesuai waktu
eksekusi. RTOS
dalam sistem akan
diterapkan pada
pengambilan data
sensor dan proses
pengolahan data
untuk mengambil
keputusan.
3 Muhammad Bagus Pada penelitian ini, Dari hasil simulasi
Bintang Timur. mobilitas nampak bahwa
Dkk. 2017. “Desain pergerakan hexapod behavior based
dan Implementasi akan diuji untuk hexapod robot
Kendali Cerdas mengetahui memiliki mobilitas
untuk Robot performanya yang
Quadpod (Berkaki dalam melewati baik (mampu melewati
Empat) – Studi balok dan tangga. halangan setinggi
Kasus Robot Supaya dapat maksimal 10 cm) dan
Pemadam Api bereaksi dengan dapat menyelesaikan
(RPA)” cepat, maka tugasnya untuk
arsitektur behavior menghindari halangan
based akan dan menemukan
digunakan pada sumber cahaya.
hexapod. Aplikasi
navigasi otonom
dipilih untuk
menunjukkan bahwa
arsitektur tersebut
berjalan dengan
baik.
BAB IV
contohnya di medan reruntuhan bangunan dengan jalur yang tidak rata, jalur
kebutuhan aplikasi yang akan dibangun. Pada tahap ini membahas mengenai
28
29
1. Arduino Uno
4. Bluetooth HC-05
5. Saklar NC
6. Batrey Lippo
8. Action Cam
9. Kabel Jumper
1. Arduino IDE
2. MITT Inventor
3. Photo Scape
30
untuk membuat robot, dari mulai merancang skema hingga fungsi kerja dari
kegiatan yang ada didalam sistem. Agar dapat lebih memahami sistem
kamera yaitu action cam yang diletakan di bagian atas pada robot
1 Process Pengolahan,
perhitungan dan
perubahan
Garis Alir
10 Arah aliran program
(Flow Line)
11 Preparation Proses
Inisialisasi/Pemberian
harga awal
Jumlah Rp 1.062.000
BAB V
IMPLEMENTASI SISTEM
5.1 Implementasi
menguji perancangan sistem yang telah dibuat agar berfungsi sesuai dengan
tujuan penelitian.
36
37
5.2.1 Perancangan
yang digunakan :
1. Arduino IDE
quadruped.
2. App Inventor
programming.
5. Servo
6. Bluetooth HC-05
8. Baterai Lippo
5.2.2 Pembuatan
Scape.
40
1. User Interface
a Button
b ListPicker
Connected.
2. Layout
3. Connectivity
5.2.3 Perakitan
gambar 5.6
gambar 5.7
gambar 5.8
kontrol android berbasis Arduino Uno ini berfungsi dengan baik dan
aplikasi yang telah dibuat dalam Robot. Dan juga dapat dianalisa
apakah sistem pada robot quadruped ini berfungsi dengan baik dan
. Menjalankan . Menjalankan
ke aplikasi ke aplikasi
bluetooth bluetooth
. Memberikan .Memberikan
perintahkan perintahkan
.Menggerakan 4
baik
BAB VI
PENUTUP
6.1 Kesimpulan
berbasis Arduino Uno yang telah diuraikan pada bab sebelumnya, maka
kemudian robot dijalankan di medan yang tidak rata atau terjal dan
6.2 Saran
sepenuhnya menjadi robot yang baik karena masih banyak kekurangan yang
1. Perlu adanya perbaikan pada kaki agar bisa berjalan lebih sempurna.
51
52
lebih bervariasi.
[1] Meryana Eka Fajarwati, Retno Rianto, Dkk. 2017. ” Rancang Bangun Robot
Berkaki Empat Pada Robot “Lizard”. 5th Indonesian Symposium on
Robotic Systems and Control.
[2] Rofiq Cahyo Prayogo, Aris Triwiyatno, Dkk. 2018. “Perancanan Robot
Berkaki 4 (Quadruped) Dengan Stabilization Alorithem Pada Uneven Floor
Mengunakan 6-DOF IMU Berbasis invers Kinematic. TRANSIENT. Vol 7.
No 2.
[3] Iswari Anggit, CNBC Indonesia. 2018 .” Era Industri 4.0, Pemerintah
Siapkan Regulasi Robotic & AI”
[4] X. Ding and F. Yang, 2016. “Study on hexapod robot manipulation using
legs”, Robotica Journal, Volume 34, Issue 2 February 2016 , pp. 468481.
[5] Hendriawan Dwi Saputro, Rizal Maulana, Dkk. 2018. “Implementasi Real
Time Pada Pergerakan Robot Quadruped menggunakan Multisensor dan
RTOS”
[6] Rachmadini Dkk. 2016. “Sistem Robot Pemadam Api Berkaki Berbasis
Arduino Pada Kontes Robot Pemadam Api Indonesia 2016”
[7] Irfan. 2014. “Sistem kendali robot mobil sederhana pada smartphone
android berbasis teknologi Bluetooth”
[8] Muhammad Bagus Bintang Timur. Dkk. 2017. “Desain dan Implementasi
Kendali Cerdas untuk Robot Quadpod (Berkaki Empat) – Studi Kasus Robot
Pemadam Api (RPA)”
[9] Adhitya Wibawa Putra. 2015 “Yi Action Camera” Tekno jurnal.
53
54
[10] Hendriawan Dwi Saputro, Rizal Maulana, Dkk 2018. “Implementasi Real
Time pada Pergerakan Robot Quadruped mengggunakan Multisensor dan
RTOS”. J-PTIIK. Vol 2. NO 12.
[12] Muhammad Fathur Rahman Wijaya, Haji Luhung Kurniantoro, Dkk 2016. “
Robot ROV Underwater BErbasis Mikrokontroler”. Jurnal Autocracy. Vol
3. No 2.
A-1
Lampiran Surat Pembimbing TA
B-1
B-2
Lampiran Source Code
#include <Servo.h>
#include <Servo.h> // servo library
#include <SoftwareSerial.h>
//////inisialisai bluetooth///
String data;
SoftwareSerial mySerial(12 ,13); //rx.tx
//////inisialisasi sensor ping///
#include <NewPing.h>
// kalibrasi
int da = -12, // kaki kiri depan
db = 10, // kaki kiri belakang
dc = -18, // kaki kanan belakang
dd = 12; // kaki kanan depan
int b0 = (0 + db),
b30 = (30 + db),
b60 = (60 + db),
b90 = (90 + db);
int d0 = (0 + dd),
d30 = (30 + dd),
d60 = (60 + dd),
d90 = (90 + dd);
int f = 0;
C-1
int b = 0;
int l = 0;
int r = 0;
int spd = 3; // inisialisai kecepatan gerak
int high = 0; // inisialisai ketingian robot berdiri
// Define 8 Servo
Servo myServo1; // kaki kiri depan servo(1)
Servo myServo2; // kaki kiri bawah depan servo(2)
Servo myServo3; // kaki kiri belakang servo(3)
Servo myServo4; // kaki kiri belakang bawah servo(4)
Servo myServo5; // kaki kanan belakang servo(5)
Servo myServo6; // kaki kanan belakang bawah servo(6)
Servo myServo7; // kaki kanan depan servo(7)
Servo myServo8; // kaki kanan bawah depan servo(8)
//===== Setup
==============================================================================
void setup()
{
mySerial.begin(9600);
}
void set1(){
myServo1.attach(A4); myServo2.attach(A5);
myServo3.attach(2); myServo4.attach(3);
myServo5.attach(10); myServo6.attach(11);
myServo7.attach(A0); myServo8.attach(A1);
}
void set2(){
myServo1.attach(2); myServo2.attach(3);
myServo3.attach(10); myServo4.attach(11);
myServo5.attach(A0); myServo6.attach(A1);
myServo7.attach(A4); myServo8.attach(A5);
}
C-2
//== Loop
===============================================================================
===
void loop()
{ int 1 = sonar1.ping_cm();
int 2 = sonar2.ping_cm();
int 3 = sonar3.ping_cm( );
Serial.print(1);
Serial.print(" ");
Serial.print(2);
Serial.print(" ");
Serial.println(3);
Serial.print(" ");
if ( mySerial.available()>0){
delay(100);
char c=mySerial.read();
data +=c;
}
if (data.length()>0){
Serial.print(data);
if (data=="0"){
maju();
delay(50);
}
else if(data=="1"){
mundur();
delay(50);
}
else if(data=="2"){
belok_kanan();
delay(50);
}
else if(data=="3"){
belok_kiri();
delay(50);
}
else if(data=="4"){
nantang();
delay(5000);
}
else if(data=="5"){
anjing();
C-3
delay(50);
}
else if(data=="6"){
naik_kanan();
delay(1000);
naik_kiri();
delay(1000);
}
else if(data=="7"){
duduk();
delay(2000);
berdiri();
delay(6000);
}
else if(data=="8"){
kuda();
delay(3000);
}
else if(data=="9"){
perpisahan();
delay(1000);
}
data="";
servo_tengah();
}
//== perpisahan
===============================================================================
===
void perpisahan()
{
servo_tengah();
myServo4.write(45);
myServo6.write(45);
delay(200);
myServo8.write(0);
delay(200);
myServo7.write(180);
delay(200);
myServo7.write(30);
delay(300);
myServo7.write(180);
delay(300);
C-4
myServo7.write(30);
delay(300);
myServo7.write(s41);
delay(300);
myServo8.write(s42);
servo_tengah();
//== merunduk
===============================================================================
====
void merunduk()
{
myServo2.write(15);
myServo8.write(15);
delay(700);
myServo2.write(90);
myServo8.write(90);
delay(700);
}
void berdiri(){
int x=150;
myServo2.write(x);
myServo4.write(x);
myServo6.write(x);
myServo8.write(x);
}
void duduk(){
int x=20;
myServo1.write(x);
myServo3.write(x);
myServo5.write(x);
myServo7 .write(x);
int y=15;
myServo2.write(y);
myServo4.write(y);
myServo6.write(y);
myServo8.write(y);
}
void nantang(){
myServo2.write(150);
myServo4.write(15);
myServo6.write(15);
myServo8.write(150);
}
C-5
void kuda(){
myServo1.write(30);
myServo3.write(150);
myServo5.write(30);
myServo7.write(150);
delay(1000);
myServo2.write(150);
myServo8.write(150);
delay(3000);
}
void anjing(){
myServo2.write(30);
myServo3.write(30);
myServo4.write(30);
myServo5.write(170);
myServo6.write(30);
myServo8.write(30);
delay(2000);
myServo1.write(30);
myServo7.write(150);
delay(2000);
myServo2.write(150);
myServo8.write(150);
delay(1000);
myServo2.write(30);
myServo8.write(150);
delay(200);
myServo2.write(150);
myServo8.write(30);
delay(200);
myServo2.write(15);
myServo8.write(150);
delay(200);
myServo2.write(150);
myServo8.write(15);
delay(200);
myServo2.write(30);
myServo8.write(150);
delay(200);
myServo2.write(150);
myServo8.write(30);
delay(200);
myServo2.write(30);
myServo8.write(150);
delay(200);
myServo2.write(30);
myServo8.write(30 );
delay(2000);
C-6
/////diam////
myServo2.write(150);
myServo8.write(30);
delay(200);
myServo2.write(30);
myServo8.write(150);
delay(200);
myServo2.write(150);
myServo8.write(30);
delay(200);
myServo2.write(30);
myServo8.write(150);
delay(200);
myServo2.write(150);
myServo8.write(30);
delay(200);
myServo2.write(30);
myServo8.write(150);
delay(200);
myServo2.write(150);
myServo8.write(150);
delay(2000);
void merdeka(){
//pivot
myServo1.write(90);
myServo3.write(15);
myServo5.write(90);
myServo7.write(150);
//lift
myServo2.write(15);
myServo4.write(150);
myServo6.write(15);
myServo8.write(150);
delay(1000);
myServo1.write(180);
delay(200);
myServo1.write(30);
delay(200);
myServo1.write(180);
delay(200);
myServo1.write(30);
delay(200);
myServo1.write(30)
C-7
delay(200);
}
//== naik_kiri
=============================================================================
void naik_kiri()
{
myServo2.write(15);
myServo4.write(15);
myServo6.write(150);
myServo8.write(150);
}
//== naik_kanan
============================================================================
void naik_kanan()
{
myServo2.write(150);
myServo4.write(150);
myServo6.write(15);
myServo8.write(15);
}
//== maju
===============================================================================
void maju()
{
// menghitung poin
C-8
c180 = (180 + dc);
// set posisi servo dan kecepatan yang dibutuhkan untuk sekali berjalan maju
// KkiD (kaki kiri depan) KkaB (kaki kanan Belakang)
// (KkiD,KkiB, KkaB, KkaD, KkiAD, KkiAB, KkaAB, KkaAD, S1, S2, S3, S4)
srv(a180, b0 , c120, d60, 42, 33, 33, 42, 1, 3, 1, 1);
srv( a90, b30, c90, d30, 6, 33, 33, 42, 3, 1, 1, 1);
srv( a90, b30, c90, d30, 42, 33, 33, 42, 3, 1, 1, 1);
srv(a120, b60, c180, d0, 42, 33, 6, 42, 1, 1, 3, 1);
srv(a120, b60, c180, d0, 42, 33, 33, 42, 1, 1, 3, 1);
srv(a150, b90, c150, d90, 42, 33, 33, 6, 1, 1, 1, 3);
srv(a150, b90, c150, d90, 42, 33, 33, 42, 1, 1, 1, 3);
srv(a180, b0, c120, d60, 42, 6, 33, 42, 1, 3, 1, 1);
//== mundur
===============================================================================
===
void mundur()
{
// set posisi servo dan kecepatan yang dibutuhkan untuk sekali berjalan mundur
// (KkiD.1,KkiB.3,KkaB.5,KkaD.7,KkiAD.2,KkiAB.4,KkaAB.6, KkaAD.8, S1, S2, S3, S4)
srv(180, 0, 120, 60, 42, 33, 33, 42, 3, 1, 1, 1);//3=5//S2=s3
srv(150, 90, 150, 90, 42, 18, 33, 42, 1, 3, 1, 1);//1=7//s1=s4
srv(150, 90, 150, 90, 42, 33, 33, 42, 1, 3, 1, 1);
srv(120, 60, 180, 0, 42, 33, 33, 6, 1, 1, 1, 3);
srv(120, 60, 180, 0, 42, 33, 33, 42, 1, 1, 1, 3);
srv(90, 30, 90, 30, 42, 33, 18, 42, 1, 1, 3, 1);
srv(90, 30, 90, 30, 42, 33, 33, 42, 1, 1, 3, 1);
srv(180, 0, 120, 60, 6, 33, 33, 42, 3, 1, 1, 1);
//== belok_kiri
===============================================================================
==
void belok_kiri()
{
// set posisi servo dan kecepatan yang dibutuhkan untuk sekali belok kiri
C-9
// (KkiD,KkiB,KkaB,KkaD,KkiAD,KkiAB,KkaAB,KkaAD,S1,S2,S3,S4)
srv(150, 90, 90, 30, 42, 6, 33, 42, 1, 3, 1, 1);
srv(150, 90, 90, 30, 42, 33, 33, 42, 1, 3, 1, 1);
srv(120, 60, 180, 0, 42, 33, 6, 42, 1, 1, 3, 1);
srv(120, 60, 180, 0, 42, 33, 33, 24, 1, 1, 3, 1);
srv(90, 30, 150, 90, 42, 33, 33, 6, 1, 1, 1, 3);
srv(90, 30, 150, 90, 42, 33, 33, 42, 1, 1, 1, 3);
srv(180, 0, 120, 60, 6, 33, 33, 42, 3, 1, 1, 1);
srv(180, 0, 120, 60, 42, 33, 33, 33, 3, 1, 1, 1);
}
//== belok_kanan
===============================================================================
=
void belok_kanan ()
{
// set posisi servo dan kecepatan yang dibutuhkan untuk sekali belok kanan
// (KkiD,KkiB,KkaB,KkaD,KkiAD,KkiAB,KkaAB,KkaAD,S1,S2,S3,S4)
srv( 90, 30, 150, 90, 6, 33, 33, 42, 3, 1, 1, 1);
srv( 90, 30, 150, 90, 42, 33, 33, 42, 3, 1, 1, 1);
srv(120, 60, 180, 0, 42, 33, 33, 6, 1, 1, 1, 3);
srv(120, 60, 180, 0, 42, 33, 33, 42, 1, 1, 1, 3);
srv(150, 90, 90, 30, 42, 33, 6, 42, 1, 1, 3, 1);
srv(150, 90, 90, 30, 42, 33, 33, 42, 1, 1, 3, 1);
srv(180, 0, 120, 60, 42, 6, 33, 42, 1, 3, 1, 1);
srv(180, 0, 120, 60, 42, 33, 33, 42, 1, 3, 1, 1);
}
void balik_kanan(){
belok_kanan();
belok_kanan();
}
void balik_kiri(){
belok_kiri();
belok_kiri();
}
void geser_kanan(){
set1();maju();set2();
}
void geser_kiri(){
set1();mundur();set2();
}
//== servo_tengah
========================================================================
void servo_tengah()
{
myServo1.write(90);
C-10
myServo2.write(90);
myServo3.write(90);
myServo4.write(90);
myServo5.write(90);
myServo6.write(90);
myServo7.write(90);
myServo8.write(90);
//== Srv
===============================================================================
====
void srv( int p11, int p21, int p31, int p41, int p12, int p22, int p32, int p42, int sp1, int sp2, int
sp3, int sp4)
{
C-11
while ((s11 != p11) || (s21 != p21) || (s31 != p31) || (s41 != p41) || (s12 != p12) || (s22 != p22)
|| (s32 != p32) || (s42 != p42))
{
C-12
{
if ((s31 - sp3) >= p31)
s31 = s31 - sp3;
else
s31 = p31;
}
C-13
}
C-14
myServo7.write(s41 + dd);
}
}
C-15