아두이노

cutter_1

내동 2020. 12. 18. 06:54

#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