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);

}

Tidak ada komentar:

Posting Komentar