ROBOT LENGAN ARDUINO
Pada kesempatan kali ini saya akan menjelaskan mengenai bagaimana cara membuat sebuah robot lengan untuk edukasi atau belajar program dengan menggunakan Arduino. jadi robot ini menggunakan 4 buah servo sehingga robot ini bisa melakukan gerakan kanan kiri, atas bawah, maju mundur, dan japit lepas. untuk lebih jelasnya berikut adalah program dan komponennya.
a. Robot Lengan
b. Program Arduino IDE
#include<Wire.h>
#include<Servo.h>
Servo myservo1;
Servo myservo2;
Servo myservo3;
Servo myservo5;
int a;
int b;
int c;
int d;
int e;
void setup(){
myservo1.attach(11); //kanan kiri
myservo2.attach(9); //maju mundur
myservo3.attach(10); //turun naik
myservo5.attach(6); //japit lepas
myservo1.write(70);
myservo2.write(130);
myservo3.write(150);
myservo5.write(150);
delay(3000);
}
void loop(){
kanan();
turun();
maju();
japit();
mundur();
naik();
kiri();
turun();
maju();
lepas();
mundur();
naik();
}
void kanan(){
for(a=70;a<=150;a++){
myservo1.write(a);
delay(50);
}
return;
}
void kiri(){
for(a=150;a>=70;a--){
myservo1.write(a);
delay(50);
}
return;
}
void mundur(){
for(b=130;b>=100;b--){
myservo2.write(b);
delay(50);
}
return;
}
void maju(){
for(b=100;b<=130;b++){
myservo2.write(b);
delay(50);
}
return;
}
void naik(){
for(c=150;c>=90;c--){
myservo3.write(c);
delay(50);
}
return;
}
void turun(){
for(c=90;c<=150;c++){
myservo3.write(c);
delay(50);
}
return;
}
void japit(){
for(e=100;e>=30;e--){
myservo5.write(e);
delay(50);
}
return;
}
void lepas(){
for(e=30;e<=100;e++){
myservo5.write(e);
delay(50);
}
return;
}
#include<Servo.h>
Servo myservo1;
Servo myservo2;
Servo myservo3;
Servo myservo5;
int a;
int b;
int c;
int d;
int e;
void setup(){
myservo1.attach(11); //kanan kiri
myservo2.attach(9); //maju mundur
myservo3.attach(10); //turun naik
myservo5.attach(6); //japit lepas
myservo1.write(70);
myservo2.write(130);
myservo3.write(150);
myservo5.write(150);
delay(3000);
}
void loop(){
kanan();
turun();
maju();
japit();
mundur();
naik();
kiri();
turun();
maju();
lepas();
mundur();
naik();
}
void kanan(){
for(a=70;a<=150;a++){
myservo1.write(a);
delay(50);
}
return;
}
void kiri(){
for(a=150;a>=70;a--){
myservo1.write(a);
delay(50);
}
return;
}
void mundur(){
for(b=130;b>=100;b--){
myservo2.write(b);
delay(50);
}
return;
}
void maju(){
for(b=100;b<=130;b++){
myservo2.write(b);
delay(50);
}
return;
}
void naik(){
for(c=150;c>=90;c--){
myservo3.write(c);
delay(50);
}
return;
}
void turun(){
for(c=90;c<=150;c++){
myservo3.write(c);
delay(50);
}
return;
}
void japit(){
for(e=100;e>=30;e--){
myservo5.write(e);
delay(50);
}
return;
}
void lepas(){
for(e=30;e<=100;e++){
myservo5.write(e);
delay(50);
}
return;
}
c. VIDEO HASILNYA
No comments:
Post a Comment