0% found this document useful (0 votes)
6 views5 pages

Control Commands for Servo Motors

Copyright
© All Rights Reserved
We take content rights seriously. If you suspect this is your content, claim it here.
Available Formats
Download as DOCX, PDF, TXT or read online on Scribd
0% found this document useful (0 votes)
6 views5 pages

Control Commands for Servo Motors

Copyright
© All Rights Reserved
We take content rights seriously. If you suspect this is your content, claim it here.
Available Formats
Download as DOCX, PDF, TXT or read online on Scribd

#include <Servo.

h>

#include <SoftwareSerial.h>

SoftwareSerial BT(10, 11);

String perintah;

int kirimundur = 2;

int kirimaju = 3;

int kananmundur = 4;

int kananmaju = 5;

//rx=11

//tx=10

Servo tengah, bawah, pelatuk;

void setup (){

[Link] (9600);

pinMode (kirimundur, OUTPUT);

pinMode (kirimaju, OUTPUT);

pinMode (kananmundur, OUTPUT);

pinMode (kananmaju, OUTPUT);

[Link](9600);

[Link] (90);

[Link] (90);

[Link] (90);

[Link](7);

[Link](6);
[Link](8);

void loop (){

while ([Link]()) {

delay(10);

char c = [Link]();

perintah += c;

if([Link]() > 0) {

[Link](perintah);

if (perintah == "1"){ //MAJU

digitalWrite (kirimaju, HIGH);

digitalWrite (kananmaju, HIGH);

digitalWrite (kirimundur, LOW);

digitalWrite (kananmundur, LOW);

else if (perintah == "2"){ //KIRI MAJU

digitalWrite (kirimaju, LOW);

digitalWrite (kananmaju, HIGH);

digitalWrite (kirimundur, LOW);

digitalWrite (kananmundur, LOW);

else if (perintah == "3"){ //KANAN MAJU

digitalWrite (kirimaju, HIGH);

digitalWrite (kananmaju, LOW);


digitalWrite (kirimundur, LOW);

digitalWrite (kananmundur, LOW);

else if (perintah == "4"){ //KANAN MAJU

digitalWrite (kirimaju, LOW);

digitalWrite (kananmaju, LOW);

digitalWrite (kirimundur, HIGH);

digitalWrite (kananmundur, HIGH);

else if (perintah == "a"){ //KANAN MAJU

digitalWrite (kirimaju, LOW);

digitalWrite (kananmaju, LOW);

digitalWrite (kirimundur, LOW);

digitalWrite (kananmundur, LOW);

else if (perintah == "x"){ //buka servo

[Link] (90);

else if (perintah == "y"){ //buka servo

[Link] (0);

//

else if (perintah == "q"){ //buka servo

[Link] (0);
}

else if (perintah == "w"){ //buka servo

[Link] (90);

else if (perintah == "j"){ //buka servo

[Link] (180);

//

else if (perintah == "t"){ //buka servo

[Link] (40);

else if (perintah == "g"){ //buka servo

[Link] (110);

else if (perintah == "b"){ //buka servo

[Link] (180);

perintah="";

You might also like