Login▼/회원가입BASIC4MCU | 질문게시판 | 초음파센서 거리를 인식해서 카운트
페이지 정보
작성자 아독 작성일2022-11-24 10:03 조회1,505회 댓글6건본문
#include <Wire.h>
#include <LiquidCrystal_I2C.h>
#include <Servo.h>
LiquidCrystal_I2C lcd(0x27, 16,2);
Servo servo, servo2;
#define trig 13
#define echo 12
#define trig2 11
#define echo2 10
int angle=0;
int count=4;
void setup() {
servo.attach(9);
servo2.attach(8);
pinMode(trig,OUTPUT);
pinMode(echo,INPUT);
pinMode(trig2,OUTPUT);
pinMode(echo2,INPUT);
lcd.init();
lcd.clear();
lcd.backlight();
void loop() {
lcd.setCursor(13,1);
lcd.print(count);
long duration, distance;
digitalWrite(trig,LOW);
digitalWrite(echo,LOW);
delayMicroseconds(2);
digitalWrite(trig,HIGH);
delayMicroseconds(2);
digitalWrite(trig,LOW);
duration=pulseIn(echo,HIGH);
distance=((float)(340*duration)/10000)/2;
if(distance<5){
angle=180;
count--;
delay(1000);
}
else{
angle=100;
delay(200);
}
servo.write(angle);
digitalWrite(trig2,LOW);
digitalWrite(echo2,LOW);
delayMicroseconds(2);
digitalWrite(trig2,HIGH);
delayMicroseconds(2);
digitalWrite(trig2,LOW);
duration=pulseIn(echo2,HIGH);
distance=((float)(340*duration)/10000)/2;
if(distance<5){
angle=180;
count++;
delay(1000);
}
else{
angle=100;
delay(200);
}
servo2.write(angle);
안녕하세요 질문있어서 작성합니다..!초음파센서가 거리를 인식하면 서보모터 작동하고 거리를 인식하는 동시에 변수 count=4를 주고 -1씩 하도록하고2번 센서가 거리를 인식하면 똑같이 작동하고 +1씩 주고 싶습니다.그런데 초음파에서 count 변수가 너무 빨리 증가 감소 합니다. 딜레이를 주면 서보모터가 같이 딜레이를 받아서 해결이 안되어서 여쭙고자 작성합니다.
- BASIC4MCU 작성글 SNS에 공유하기
댓글 6
조회수 1,505master님의 댓글
master 작성일
#include <Wire.h>
#include <LiquidCrystal_I2C.h>
LiquidCrystal_I2C lcd(0x27, 16,2);
//
#include <Servo.h>
Servo servo,servo2;
//
#define trig 13
#define echo 12
#define trig2 11
#define echo2 10
//
int angle=0,count=4,mode=0;
//
void setup() {
servo.attach(9); servo2.attach(8);
pinMode(trig,OUTPUT); pinMode(echo,INPUT);
pinMode(trig2,OUTPUT); pinMode(echo2,INPUT);
lcd.init(); lcd.clear(); lcd.backlight();
}
//
void loop() {
lcd.setCursor(13,1); lcd.print(count);
long duration, distance;
digitalWrite(trig,HIGH); delayMicroseconds(10); digitalWrite(trig,LOW);
duration=pulseIn(echo,HIGH);
distance=((float)(340*duration)/10000)/2;
if(distance<5){ if(mode!=1){ mode=1; count--; } angle=180; servo.write(angle); delay(1000); }
else{ angle=100; servo.write(angle); delay(200); }
//-----------------------
digitalWrite(trig2,HIGH); delayMicroseconds(10); digitalWrite(trig2,LOW);
duration=pulseIn(echo2,HIGH);
distance=((float)(340*duration)/10000)/2;
//
if(distance<5){ if(mode!=2){ mode=2; count++; } angle=180; servo2.write(angle); delay(1000); }
else{ angle=100; servo2.write(angle); delay(200); }
}
아독님의 댓글
아독
작성일
감사합니다ㅠㅠ 그런데 1씩증가감소하고, 더이상 카운트가 되지 않는데 뭐가 문제일까요ㅠㅠ?
master님의 댓글
master 작성일
#include <Wire.h>
#include <LiquidCrystal_I2C.h>
LiquidCrystal_I2C lcd(0x27,16,2);
//
#include <Servo.h>
Servo servo,servo2;
//
#define trig 13
#define echo 12
#define trig2 11
#define echo2 10
//
int count=4,mode=0,t1=0,t2=0;
//
void setup() {
servo.attach(9); servo2.attach(8);
pinMode(trig,OUTPUT); pinMode(echo,INPUT);
pinMode(trig2,OUTPUT); pinMode(echo2,INPUT);
lcd.init(); lcd.clear(); lcd.backlight();
}
//
void loop() {
digitalWrite(trig,1); delayMicroseconds(10); digitalWrite(trig,0);
long duration1=pulseIn(echo,1);
long distance1=((float)(340*duration1)/10000)/2;
delay(100);
//-----------------------
digitalWrite(trig2,1); delayMicroseconds(10); digitalWrite(trig2,0);
long duration2=pulseIn(echo2,1);
long distance2=((float)(340*duration2)/10000)/2;
delay(100);
//-----------------------
if(distance1<5){ if(mode!=1){ mode=1; t1=5; } count--; }
else if(distance2<5){ if(mode!=2){ mode=2; t2=5; } count++; }
else mode=0;
//-----------------------
lcd.setCursor(13,1); lcd.print(count);
//-----------------------
if(t1){ t1--; servo1.write(180); } else{ servo1.write(100); }
if(t2){ t2--; servo2.write(180); } else{ servo2.write(100); }
}
카운터 증가 감소 주기는 얼마로 하고 싶은 걸까요?
아독님의 댓글
아독 작성일5초이상 10초미만으로 하고 싶습니다! 주기가 너무 빨라서 잠깐 센서에 닿아도 카운트가 빨리 되어서요..ㅠㅠㅠ
아독님의 댓글
아독 작성일
물체 움직임이 감지되면 센서에 게속 감지되어도 카운트는 하나씩만 되게 하고 싶어요
계속 카운트가 되어서요
master님의 댓글
master 작성일
수정했으니 다시 돌려보세요
근접하면 1회만 동작합니다.