Kamis, 20 Desember 2018

program quadrued berdiri

 #include <Servo.h>
int LEDhijau = A3, LEDmerah = A2, LEDcampur = A4;
Servo servoku13;
Servo servoku2;
Servo servoku3;
Servo servoku4;
Servo servoku5;
Servo servoku6;
Servo servoku7;
Servo servoku8;
Servo servoku9;
Servo servoku10;
Servo servoku11;
Servo servoku12;

void setup() {
 pinMode(LEDmerah, OUTPUT); //Set LEDmerah sebagai output
 pinMode(LEDhijau, OUTPUT); //Set LEDhijau sebagai output
  pinMode(LEDcampur, OUTPUT); //Set LEDhijau sebagai output


 
  servoku13.attach(13); 
servoku2.attach(2); 
servoku3.attach(3);
servoku4.attach(4); 
servoku5.attach(5); 
servoku6.attach(6); 
servoku7.attach(7);
servoku8.attach(8); 
servoku9.attach(9); 
servoku10.attach(10);
servoku11.attach(11); 
servoku12.attach(12);


}

void loop() {


 
  servoku4.write(130); //atas
servoku5.write(40);
servoku6.write(115);

 servoku13.write(70); //atas
servoku2.write(35);
servoku3.write(70);

servoku7.write(130); //tengah //kaki belakang
servoku8.write(150);
servoku9.write(93);

servoku10.write(120); //tengah //kaki belakang
servoku11.write(40);
servoku12.write(60);

////=====kaki tegak belakang====////



 servoku13.write(70); //atas
servoku2.write(70);
servoku3.write(105);


servoku4.write(130); //atas
servoku5.write(15);
servoku6.write(90);


servoku7.write(160); //tengah //kaki belakang
servoku8.write(150);
servoku9.write(95);

servoku10.write(80); //tengah //kaki belakang
servoku11.write(20);
servoku12.write(45);
 
 
///=================////tegak belok kiri///===
servoku4.write(130); //atas
servoku5.write(20);
servoku6.write(90);

 servoku13.write(70); //atas
servoku2.write(50);
servoku3.write(95);

servoku7.write(130); //tengah //kaki belakang
servoku8.write(150);
servoku9.write(93);

servoku10.write(120); //tengah //kaki belakang
servoku11.write(40);
servoku12.write(60);

}
Diposting oleh di Tidak ada komentar:

pemrograman robt quadruped ciptaan tatang xman putra recpeck 619


(belok kiri)

#include <Servo.h>
int LEDhijau = A3, LEDmerah = A2, LEDcampur = A4;
Servo servoku13;
Servo servoku2;
Servo servoku3;
Servo servoku4;
Servo servoku5;
Servo servoku6;
Servo servoku7;
Servo servoku8;
Servo servoku9;
Servo servoku10;
Servo servoku11;
Servo servoku12;

void setup() {
 pinMode(LEDmerah, OUTPUT); //Set LEDmerah sebagai output
 pinMode(LEDhijau, OUTPUT); //Set LEDhijau sebagai output
  pinMode(LEDcampur, OUTPUT); //Set LEDhijau sebagai output


 
  servoku13.attach(13); 
servoku2.attach(2); 
servoku3.attach(3);
servoku4.attach(4); 
servoku5.attach(5); 
servoku6.attach(6); 
servoku7.attach(7);
servoku8.attach(8); 
servoku9.attach(9); 
servoku10.attach(10);
servoku11.attach(11); 
servoku12.attach(12);


}

void loop() {
  servoku13.write(90); //bawah
 delay(100);
servoku2.write(30);
servoku8.write(140);
 delay(50);
servoku13.write(30); //atas
servoku7.write(140); //tengah //kaki belakang
delay(100);

servoku5.write(50);
servoku2.write(50);
 delay(50);
servoku4.write(100); //atas
servoku13.write(60); //tengah
 delay(100);

 servoku11.write(20);
delay(50);
servoku10.write(60); //atas //kaki belakang
 delay(100);
servoku5.write(30);
 delay(50);
servoku4.write(120); //tengah
 servoku13.write(90); //bawah
 servoku7.write(160);
 delay(100);



servoku8.write(170);
delay(50);
servoku7.write(100); //atas //kaki belakang
delay(100);
servoku8.write(140);
servoku11.write(40);
delay(50);
servoku7.write(140); //tengah //kaki belakang
servoku10.write(100); //tengah //kaki belakang
servoku4.write(150); //bawah
delay(100);



servoku6.write(110);
 servoku3.write(95);
 servoku9.write(93);
 servoku12.write(50);

}


{belok kanan}


#include <Servo.h>
int LEDhijau = A3, LEDmerah = A2, LEDcampur = A4;
Servo servoku13;
Servo servoku2;
Servo servoku3;
Servo servoku4;
Servo servoku5;
Servo servoku6;
Servo servoku7;
Servo servoku8;
Servo servoku9;
Servo servoku10;
Servo servoku11;
Servo servoku12;

void setup() {
 pinMode(LEDmerah, OUTPUT); //Set LEDmerah sebagai output
 pinMode(LEDhijau, OUTPUT); //Set LEDhijau sebagai output
  pinMode(LEDcampur, OUTPUT); //Set LEDhijau sebagai output


 
  servoku13.attach(13); 
servoku2.attach(2); 
servoku3.attach(3);
servoku4.attach(4); 
servoku5.attach(5); 
servoku6.attach(6); 
servoku7.attach(7);
servoku8.attach(8); 
servoku9.attach(9); 
servoku10.attach(10);
servoku11.attach(11); 
servoku12.attach(12);


}

void loop() {

servoku4.write(90); //bawah
delay(200);
servoku5.write(40);
servoku11.write(40);
 delay(50);
servoku4.write(150); //atas
servoku10.write(100); //tengah //kaki belakang
servoku7.write(100); //bawah //kaki belakang
delay(200);

servoku5.write(20);
servoku2.write(30);
 delay(50);
servoku13.write(110); //atas
servoku4.write(120); //tengah
servoku10.write(60); //bawah
 delay(200);


servoku8.write(170);
servoku2.write(50);
delay(50);
servoku7.write(177); //atas //kaki belakang
servoku13.write(90); //tengah
servoku4.write(130); //bawah
delay(200);


servoku11.write(20);
servoku8.write(150);
delay(50);
servoku10.write(120); //atas //kaki belakang
servoku7.write(150); //tengah //kaki belakang
servoku13.write(50); //bawah
 delay(200);



servoku6.write(85);
 servoku3.write(95);
 servoku9.write(93);
 servoku12.write(60);

}



{maju}

#include <Servo.h>
int LEDhijau = A3, LEDmerah = A2, LEDcampur = A4;
Servo servoku13;
Servo servoku2;
Servo servoku3;
Servo servoku4;
Servo servoku5;
Servo servoku6;
Servo servoku7;
Servo servoku8;
Servo servoku9;
Servo servoku10;
Servo servoku11;
Servo servoku12;

void setup() {
 pinMode(LEDmerah, OUTPUT); //Set LEDmerah sebagai output
 pinMode(LEDhijau, OUTPUT); //Set LEDhijau sebagai output
  pinMode(LEDcampur, OUTPUT); //Set LEDhijau sebagai output


 
  servoku13.attach(13); 
servoku2.attach(2); 
servoku3.attach(3);
servoku4.attach(4); 
servoku5.attach(5); 
servoku6.attach(6); 
servoku7.attach(7);
servoku8.attach(8); 
servoku9.attach(9); 
servoku10.attach(10);
servoku11.attach(11); 
servoku12.attach(12);


}

void loop() {
 


servoku8.write(170);
delay(50);
servoku7.write(100); //atas //kaki belakang
delay(200);
servoku8.write(140);
delay(50);


servoku2.write(15);
 delay(50);
servoku13.write(30); //atas
 delay(200);
servoku2.write(35);
 delay(70);
servoku13.write(60); //tengah


 servoku7.write(120); //tengah //kaki belakang
servoku10.write(50); //bawah //kaki belakang
servoku4.write(70); //bawah
delay(200);

/////////////============kaki kanan======///////

servoku11.write(20);
delay(50);
servoku10.write(120); //atas //kaki belakang
 delay(200);
servoku11.write(40);
delay(50);



servoku5.write(60);
 delay(50);
servoku4.write(130); //atas
delay(200);
servoku5.write(40);
 delay(70);
servoku4.write(100); //tengah
servoku7.write(150); //bawah //kaki belakang
servoku13.write(100); //bawah
servoku10.write(100); //tengah
delay(200);



servoku3.write(70);
servoku9.write(90);
servoku6.write(115);
servoku12.write(60);



}

{mundur}

 #include <Servo.h>
int LEDhijau = A3, LEDmerah = A2, LEDcampur = A4;
Servo servoku13;
Servo servoku2;
Servo servoku3;
Servo servoku4;
Servo servoku5;
Servo servoku6;
Servo servoku7;
Servo servoku8;
Servo servoku9;
Servo servoku10;
Servo servoku11;
Servo servoku12;

void setup() {
 pinMode(LEDmerah, OUTPUT); //Set LEDmerah sebagai output
 pinMode(LEDhijau, OUTPUT); //Set LEDhijau sebagai output
  pinMode(LEDcampur, OUTPUT); //Set LEDhijau sebagai output


 
  servoku13.attach(13); 
servoku2.attach(2); 
servoku3.attach(3);
servoku4.attach(4); 
servoku5.attach(5); 
servoku6.attach(6); 
servoku7.attach(7);
servoku8.attach(8); 
servoku9.attach(9); 
servoku10.attach(10);
servoku11.attach(11); 
servoku12.attach(12);


}

void loop() {


servoku2.write(50);
 delay(50);
servoku13.write(130); //atas
 delay(200);
servoku2.write(70);
 delay(50);


servoku8.write(170);
delay(50);
servoku7.write(170); //atas //kaki belakang
delay(200);
servoku8.write(150);
delay(70);

servoku7.write(150); //tengah //kaki belakang
servoku13.write(80); //tengah
servoku10.write(110); //bawah //kaki belakang
servoku4.write(130); //bawah
delay(200);



//////////================//////////



servoku5.write(35);
 delay(50);
servoku4.write(80); //atas
delay(200);
servoku5.write(15);
 delay(50);

servoku11.write(0);
delay(50);
servoku10.write(70); //atas //kaki belakang
 delay(200);
servoku11.write(20);
delay(70);

servoku4.write(110); //tengah
servoku10.write(90); //tengah //kaki belakang
 servoku13.write(50); //bawah
 servoku7.write(130); //bawah //kaki belakang
 delay(200);

servoku7.write(130);
servoku6.write(80);
 servoku3.write(105);
servoku12.write(50);

}











Diposting oleh di Tidak ada komentar:

Rabu, 12 Desember 2018

program kontrol motor dc dan motor servo dengan android

#include <Servo.h>
Servo myservo1, myservo2, myservo3;
String readdata;

void setup() {
Serial.begin(9600);
myservo1.attach(7);
myservo2.attach(8);
myservo3.attach(9);
pinMode(4, OUTPUT);
pinMode(2, OUTPUT);
pinMode(5, OUTPUT);
pinMode(3, OUTPUT);

}
//-----------------------------------------------------------------------//
void loop() {
while (Serial.available()){ 
delay(10);
  char c = Serial.read();
readdata += c;
  }
if (readdata.length() > 0) {
Serial.println(readdata);

if(readdata == "maju")
  {
digitalWrite(4, HIGH);
digitalWrite (2, HIGH);
digitalWrite(5,LOW);
digitalWrite(3,LOW);
delay(100);

  }
  else if(readdata == "mundur")
  {
digitalWrite(4, LOW);
digitalWrite(2, LOW);
digitalWrite(5, HIGH);
digitalWrite(3,HIGH);
delay(100);
  }

else if (readdata == "kanan")
  {

digitalWrite (4, LOW);
digitalWrite (2, HIGH);
digitalWrite (5, HIGH);
digitalWrite (3, LOW);
delay (100);
  }

else if ( readdata == "kiri")
 {

digitalWrite (4,HIGH);
digitalWrite (2,LOW);
digitalWrite (5,LOW);
digitalWrite (3,HIGH);
delay (100);
 }

else if (readdata == "stop")
 {
digitalWrite (4, LOW);
digitalWrite (2, LOW);
digitalWrite (5, LOW);
digitalWrite (3, LOW);
delay (100);
 }

 ///////////+++++++batas lengan+++++///////////

else if(readdata == "rebah") //posisi kedua
  {
 myservo1.write(120); ///rebah
  myservo2.write(100);
   myservo3.write(20);
{
  delay(1500);
}
 myservo1.write(120); //buka
  myservo2.write(125);
     myservo3.write(30);
{
  delay(1500);
}
  }

else if (readdata == "jepit") //posisi ke 3
  {
  myservo1.write(120); ///jepit
  myservo2.write(125);
     myservo3.write(70);
{
  delay(1500);
}
     myservo1.write(100); //posisi angkat belakang
  myservo2.write(180);
     myservo3.write(70);
{
  delay(1500);
}
     myservo1.write(20); //posisi buang
  myservo2.write(180);
     myservo3.write(70);
{
  delay(1500);
}

  }
else if ( readdata == "buka") //posisi 4
 {
myservo1.write(20); //posisi buka
  myservo2.write(180);
     myservo3.write(30);

 {
  delay(1500);
  }
 }

else if (readdata == "otomatis") //posisi 5
 {
myservo1.write(0); //posisi awal
  myservo2.write(0);
   myservo3.write(70);
{
  delay(1500);
}
myservo1.write(50); //posisi awal 2
  myservo2.write(0);
   myservo3.write(70);
{
  delay(1500);
}
   myservo1.write(120); ///rebah
  myservo2.write(100);
   myservo3.write(20);
{
  delay(1500);
}
 myservo1.write(120); //buka
  myservo2.write(125);
     myservo3.write(30);
{
  delay(1500);
}
      myservo1.write(120); ///jepit
  myservo2.write(125);
     myservo3.write(70);
{
  delay(1500);
}
     myservo1.write(100); //posisi angkat belakang
  myservo2.write(180);
     myservo3.write(70);
{
  delay(1500);
}
     myservo1.write(20); //posisi buang
  myservo2.write(180);
     myservo3.write(70);
{
  delay(1500);
}
  myservo1.write(20); //posisi buka
  myservo2.write(180);
     myservo3.write(30);

 {
  delay(1500);
  }
 }


 else if ( readdata == "1") //posisi 4
 {
myservo1.write(140); ///rebah
  myservo2.write(140);
   myservo3.write(20);
  }

readdata="";}} //Reset the variable

Diposting oleh di Tidak ada komentar:
Langganan: Postingan (Atom)