Automatic Slide Gate Maket

Last crawled date: 2 years ago

Automatic slide gate used 3v gearbox motor, rack and pinion


int i = 0;
int dcR = 10;
int dcL = 11;
int pbR = 3;
int pbL = 5;
int lsR = 6;
int lsL = 7;
int emg = 4;
int hasilKanan;
int hasilKiri;
int limitKanan;
int limitKiri;
int pbEmg;


void setup ()
{
Serial.begin(9600);
pinMode(dcR,OUTPUT);
pinMode(dcL,OUTPUT);
pinMode(pbR,INPUT);
pinMode(pbL,INPUT);
pinMode(lsR,INPUT);
pinMode(lsL,INPUT);
}

void loop ()
{
hasilKanan=digitalRead(pbR);
if(hasilKanan==1){
i++;
delay(300);
}
hasilKiri=digitalRead(pbL);
if(hasilKiri==1){
i=i-1;
delay(300);
}
limitKanan=digitalRead(lsR);
if(limitKanan==1){
i=0;
delay(300);
}
limitKiri=digitalRead(lsL);
if(limitKiri==1){
i=0;
delay(300);
}
pbEmg=digitalRead(emg);
if(pbEmg==1){
i=0;
delay(300);
}

switch(i){
case 0:
digitalWrite(dcR,LOW);
digitalWrite(dcL,LOW);
break;
case -1:
digitalWrite(dcL,HIGH);
digitalWrite(dcR,LOW);
break;
case 1:
digitalWrite(dcR,HIGH);
digitalWrite(dcL,LOW);
break;
default:
break;
}
Serial.println(i);
if(limitKiri==1 && hasilKanan==1){
digitalWrite (dcR,HIGH);
digitalWrite (dcL,LOW);
}
if(limitKanan==1 && hasilKiri==1){
digitalWrite (dcR,LOW);
digitalWrite (dcL,HIGH);
}
}