Untitled

 avatar
unknown
plain_text
4 years ago
3.0 kB
4
Indexable
#include <Servo.h>
Servo myservo;

int k1=7;
int k2=6;
int k3=5;
int k4=4;
  
int b1=11;
int b2=10;
int b3=9;
int b4=8;

void setup()
{
  myservo.attach(A0);
  pinMode(k1, OUTPUT);
  pinMode(k2, OUTPUT);
  pinMode(k3, OUTPUT);
  pinMode(k4, OUTPUT);
  
  pinMode(b1, INPUT);
  pinMode(b2, INPUT);
  pinMode(b3, INPUT);
  pinMode(b4, INPUT);
  
  Serial.begin(9600);
}

void loop()
{
  digitalWrite(k1, HIGH);
  digitalWrite(k2, HIGH);
  digitalWrite(k3, HIGH);
  digitalWrite(k4, HIGH);
  
  digitalWrite(b1, HIGH);
  digitalWrite(b2, HIGH);
  digitalWrite(b3, HIGH);
  digitalWrite(b4, HIGH);
 
//-----------------------------
  digitalWrite(k1, LOW);
  delayMicroseconds(1);
 
  	if(digitalRead(b1)==LOW)
  {
      myservo.write(10);
    Serial.println("10 Derajat");
    delay(250);
    return;
  }
  	else if(digitalRead(b2)==LOW)
  {
      myservo.write(40);
    Serial.println("40 Derajat");
    delay(250);
    return;
  }
  	else if(digitalRead(b3)==LOW)
  {
      myservo.write(70);
    Serial.println("70 Derajat");
    delay(250);
    return;
  }
 	 else if(digitalRead(b4)==LOW)
  {
       myservo.write(100);
    Serial.println("100 Derajat");
    delay(250);
    return;
  }
  
  //------------------------------
  digitalWrite(k2, LOW);
  delayMicroseconds(1);
 
  	if(digitalRead(b1)==LOW)
  {
      myservo.write(20);
    Serial.println("20 Derajat");
    delay(250);
    return;
  }
  	else if(digitalRead(b2)==LOW)
  {
      myservo.write(50);
    Serial.println("50 Derajat");
    delay(250);
    return;
  }
  	else if(digitalRead(b3)==LOW)
  {
      myservo.write(80);
    Serial.println("80 Derajat");
    delay(250);
    return;
  }
 	 else if(digitalRead(b4)==LOW)
  {
       myservo.write(0);
    Serial.println("0 Derajat");
    delay(250);
    return;
  }
  
//--------------------------------
    digitalWrite(k3, LOW);
  delayMicroseconds(1);
 
  	if(digitalRead(b1)==LOW)
  {
      myservo.write(30);
    Serial.println("30 Derajat");
    delay(250);
    return;
  }
  	else if(digitalRead(b2)==LOW)
  {
      myservo.write(60);
    Serial.println("60 Derajat");
    delay(250);
    return;
  }
  	else if(digitalRead(b3)==LOW)
  {
      myservo.write(90);
    Serial.println("90 Derajat");
    delay(250);
    return;
  }
 	 else if(digitalRead(b4)==LOW)
  {
       myservo.write(180);
    Serial.println("180 ");
    delay(250);
    return;
  }
  
//--------------------------------
    digitalWrite(k4, LOW);
  delayMicroseconds(1);
 
  	if(digitalRead(b1)==LOW)
  {
    Serial.println("Tombol A");
    delay(250);
    return;
  }
  	else if(digitalRead(b2)==LOW)
  {
    Serial.println("Tombol B");
    delay(250);
    return;
  }
  	else if(digitalRead(b3)==LOW)
  {
    Serial.println("Tombol C");
    delay(250);
    return;
  }
 	 else if(digitalRead(b4)==LOW)
  {
    Serial.println("Tombol D");
    delay(250);
    return;
  }
}
Editor is loading...