BASIC4MCU | 질문게시판 | 답변 : 스위치로 서보모터를 이용한 엘리베이터 제작 중 도움이 필요합니다.
페이지 정보
작성자 master 작성일2023-11-17 05:49 조회1,696회 댓글1건본문
#include <Servo.h>
Servo myservo;
int btn1=4,btn2=5,btn3=6,btn4=7;
int LED=10;
int trig=11,echo=12;
//
float duration,distance;
long t,t1,t2;
//
void setup(){
pinMode(LED,OUTPUT);
pinMode(trig,OUTPUT); //pinMode(echo,INPUT);
//pinMode(btn1,INPUT); pinMode(btn2,INPUT); pinMode(btn3,INPUT); pinMode(btn4,INPUT);
myservo.attach(9);
Serial.begin(9600);
}
//
void loop(){
t=millis();
if(t-t1>=100){ t1=t;
digitalWrite(trig,1); delayMicroseconds(10); digitalWrite(trig,0);
duration=pulseIn(echo,1);
distance=((float)(duration*340)/10000)/2 ;
Serial.print("Distance: "); Serial.print(distance); Serial.println("cm");
//
if(distance<=10)digitalWrite(LED,0);
}
//---------------------------------------------
if(digitalRead(btn1)){ t2=t+ 500; myservo.write(180); digitalWrite(LED,1); }
if(digitalRead(btn2)){ t2=t+ 500; myservo.write( 0); }
if(digitalRead(btn3)){ t2=t+1000; myservo.write(180); }
if(digitalRead(btn4)){ t2=t+1000; myservo.write( 0); }
//
if(t>t2){ myservo.write( 90); }
}
댓글 1
조회수 1,696나나나리리님의 댓글
나나나리리 작성일답변 감사합니다 ㅠㅠ 일과 끝나고 적용해보겠습니다