Pada kesempatan kali ini saya akan menjelaskan mengenai bagaimana cara mengakses robot lengan yang dilengkapi dengan mini servo sg90 sebanyak 4 buah, keempat buah servo tersebut memiliki fungsi gerakan yang berbeda misal untuk servo 1 adalah untuk gerak kanan kiri dan servo 2 untuk gerak maju mundur kemudian servo 3 untuk gerak atas bawah dan yang servo 4 untuk japit lepas. untuk lebih jelasnya berikut adalah program dan komponennya.
a. Arduino Uno
b. Mini Servo SG90
c. Program Arduino IDE (Robot)
#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);
myservo2.attach(9);
myservo3.attach(10);
myservo5.attach(7);
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 turun(){
for(c=150;c>=90;c--){
myservo3.write(c);
delay(50);
}
return;
}
void naik(){
for(c=90;c<=150;c++){
myservo3.write(c);
delay(50);
}
return;
}
void japit(){
for(e=150;e>=120;e--){
myservo5.write(e);
delay(50);
}
return;
}
void lepas(){
for(e=120;e<=150;e++){
myservo5.write(e);
delay(50);
}
return;
}
d. Program Arduino IDE (Test Servo)
#include<Wire.h>
#include <Servo.h>
Servo myservo;
void setup(){
myservo.attach(9);
myservo.write(100);
}
void loop(){
myservo.write(100);
delay(1000);
myservo.write(150);
delay(1000);
}
e. VIDEO HASILNYA
No comments:
Post a Comment