BASIC4MCU | 질문게시판 | 초음파센서와 진동모터 제어
페이지 정보
작성자 랑공 작성일2020-06-16 10:11 조회3,740회 댓글0건본문
안녕하세요 초음파 센서 2개와 진동모터모듈을 이용해서 일정 거리 안으로 들어오면 진동이 울리게 하고 싶습니다
첫번째 초음파센서는 시리얼모니터에 결과값이 나오고 진동이 울리는데 두번째 초음파센서는 결과값이 안나옵니다
뭐가 잘못되었는지 알려주세요 ㅠㅠ
int trig1=8;
int echo1=9;
int trig2=12;
int echo2=11;
int led=4;
int CDSPin=A1;
int Shock=3;
void setup(){
Serial.begin(9600);
pinMode(trig1,OUTPUT);
pinMode(echo1,INPUT);
pinMode(trig2,OUTPUT);
pinMode(echo2,INPUT);
pinMode(Shock,OUTPUT);
pinMode(led,OUTPUT);
}
void loop(){
int cds=analogRead(A1);
Serial.println(cds);
if(cds>1000)
{
digitalWrite(led,HIGH);
}
else
{
digitalWrite(led,LOW);
}
delay(200);
Serial.println(cds);
digitalWrite(trig1,HIGH);
digitalWrite(trig2,HIGH);
delayMicroseconds(10);
digitalWrite(trig1,LOW);
digitalWrite(trig2,LOW);
int duration1 = pulseIn(echo1, HIGH);
int duration2 = pulseIn(echo2, HIGH);
int dis1= (float)(duration1 / 58.0);
int dis2= (float)(duration2 / 58.0);
Serial.print(dis1);
Serial.print(dis2);
Serial.println("cm");
pinMode(Shock,HIGH);
if(dis1<30)
{
digitalWrite(Shock,HIGH);
}
if(dis2<50)
{
digitalWrite(Shock,HIGH);
}
else
{
digitalWrite(Shock,LOW);
}
delay(500);
}
댓글 0
조회수 3,740등록된 댓글이 없습니다.