Login▼/회원가입BASIC4MCU | 질문게시판 | 답변 : 초음파 센서와 dc모터 질문있습니다.
페이지 정보
작성자 master 작성일2022-07-10 14:42 조회8,270회 댓글1건본문
int trig=8,echo=9;
//
float Lenght;
float new_dist;
int old_dist,n,d;
//
void setup(){
pinMode(trig,OUTPUT); pinMode(echo,INPUT);
Serial.begin(9600);
}
//
void loop(){
digitalWrite(trig,1); delayMicroseconds(10); digitalWrite(trig,0);
Lenght=pulseIn(echo,HIGH);
new_dist=((float)(340*Lenght)/10000)/2;
Serial.print(new_dist); Serial.println("Cm");
//
if((old_dist+1)<=new_dist){ // 1cm 이상 멀어지면
n=new_dist-old_dist;
old_dist+=n;
d=n*1000;
Serial.print(old_dist); Serial.print("Cm,cnt="); Serial.println(n);
dc모터 정방향 회전
delay(d); // cm당 1초
dc모터 정지;
}
//
if((old_dist-1)>=new_dist){ // 1cm 이상 가까워지면
n=old_dist-new_dist;
old_dist-=n;
d=n*1000;
Serial.print(old_dist); Serial.print("Cm,cnt="); Serial.println(n);
dc모터 역방향 회전
delay(d); // cm당 1초
dc모터 정지;
}
delay(100);
}
- BASIC4MCU 작성글 SNS에 공유하기
댓글 1
조회수 8,270뉴비에오님의 댓글
뉴비에오 작성일정말로 감사드립니다!