#define MS_1 13
#define Ms_2 12
#define Ls_1 10
#define Ls_2 9
#define Cutter 8
//--------------------------- input -------------------------------
#define Start_Bt 11
int state = 1;
boolean Val_1,Val_2, Val_3;
unsigned long time_pre, time_current;
void setup() {
pinMode(Start_Bt, INPUT);
pinMode(Ls_1 , INPUT);
pinMode(Ls_2 , INPUT);
pinMode(Ms_1,OUTPUT);
pinMode(Ms_2,OUTPUT);
pinMode(Cutter,OUTPUT);
digitalWrite( Cutter, LOW);
digitalWrite( Ms_1, LOW);
digitalWrite(Ms_2,LOW);
time_pre=millis();
delay(100);
}
void loop() {
Val_1=digitalRead(Start_Bt);
if(Val_1){digitalWrite(Cutter,HIGH);
Forworad(); pause(); Backworad();
digitalWrite(Cutter,LOW);
}
else{digitalWrite( Cutter, LOW);
digitalWrite( Ms_1, LOW);
digitalWrite(Ms_2,LOW);}
delay(500);
}
void Forworad(){
digitalWrite(Ms_1,HIGH);
digitalWrite(Ms_2,LOW);
Val_2=digitalRead(Ls_1);
if(Val_2){digitalWrite(Ms_1,LOW);
digitalWrite(Ms_2,LOW);
digitalWrite(Cutter,LOW);}
delay(500);}
void Backworad(){
digitalWrite(Ms_2,LOW);
digitalWrite(Ms_2,HIGH);
digitalWrite(Cutter,LOW);
Val_3=digitalRead(Ls_2);
if(Val_3){digitalWrite(Ms_1,LOW);
digitalWrite(Ms_2,LOW);
digitalWrite(Cutter,LOW);}
delay(500);}
void pause(){
time_current=millis();
if(time_current - time_pre >1000){
time_pre = time_current;
digitalWrite(Ms_1,LOW);digitalWrite(Ms_2,LOW);
}
}
'아두이노' 카테고리의 다른 글
dc 모터 위치 보내기 (0) | 2021.01.17 |
---|---|
원단커터기 자동화 (0) | 2021.01.14 |
건널목신호대 (0) | 2020.11.29 |
세탁기 코드 (0) | 2020.08.19 |
motor driver (0) | 2020.07.12 |