PROGRAM UNTUK MEMERIKSA DERAJAT

#include<Servo.h>

Servo bawah;

void setup() {

bawah.attach(3);

void loop() {

bawah.write(50);

}
PROGRAM UNTUK MENGGERAKKAN SERVO DENGAN BLUETOOTH

#include <SoftwareSerial.h>

#include <Servo.h>

SoftwareSerial module_bluetooth(0, 1); // pin RX | TX

Servo bawah;

Servo kanan;

Servo kiri;

Servo depan;

char data = 0;

void setup()

Serial.begin(9600);

bawah.attach(3);

kanan.attach(5);

kiri.attach(6);

depan.attach(9);

void loop()

if(Serial.available() > 0)

data = Serial.read();

Serial.println(data); //Pembacaan dan ditampilkan data yang masuk

//Data yang masuk

//ini servo bawah

if(data == '1'){ // Posisi di Kiri

for(int pos = 0; pos < 180; pos++)

bawah.write(pos);

delay(15);

delay(1000);

if(data == '2'){ // Posisi di Kanan

for(int pos = 180; pos >= 0; pos--)

bawah.write(pos);

delay(15);

delay(1000);

//ini servo Kanan

if(data == '3'){ // Posisi di Bawah

for(int pos = 40; pos < 120; pos++)

kanan.write(pos);

delay(15);

delay(1000);
}

if(data == '4'){ // Posisi di Atas

for(int pos = 120; pos >= 40; pos--)

kanan.write(pos);

delay(15);

delay(1000);

//ini servo kiri

if(data == '5'){ // Posisi di Naik

for(int pos = 120; pos >= 50; pos--)

kiri.write(pos);

delay(15);

delay(1000);

if(data == '6'){ // Posisi di Turun

for(int pos = 50; pos < 120; pos++)

kiri.write(pos);

delay(15);

delay(1000);

}
 }