BASIC4MCU | 질문게시판 | 답변 : 초음파+스텝모터
페이지 정보
작성자 master 작성일2022-05-23 04:42 조회407회 댓글0건본문
#include<Stepper.h>
#define STEPS 2048
int StepperAngle=60;
Stepper myStepper(StepperAngle,11,9,10,8);
int trigPin=7,echoPin=6;
//
bool pos=0; // 현재 포지션은 0 // if(value<5) 조건
//
void setup(){
myStepper.setSpeed(30);
pinMode(echoPin,INPUT); pinMode(trigPin,OUTPUT);
Serial.begin(9600);
}
//
void loop(){
digitalWrite(trigPin,HIGH); delay(10); digitalWrite(trigPin,LOW);
long duration=pulseIn(echoPin,HIGH);
long value=duration/29/0.2; //DIstance=((float)(340*duration)/10000)/2;
Serial.println(duration);
Serial.print("\nDIstance:"); Serial.print(value); Serial.println("cm");
delay(100);
if(value>5){
if(pos==0){ pos=1; myStepper.step(StepperAngle); }
}
else{ // if(value<5)
if(pos==1){ pos=0; myStepper.step(-StepperAngle); }
}
}
속도는 직접 실험해서
탈조하지 않는 상태에서 가장 빠른 속도를 찾으세요
myStepper.setSpeed(30);
댓글 0
조회수 407등록된 댓글이 없습니다.