Login▼/회원가입BASIC4MCU | 질문게시판 | 답변 : (아두이노)qr리더기 gm65 관련 질문입니다.
페이지 정보
작성자 master 작성일2022-12-10 06:32 조회1,315회 댓글0건본문
#include <Servo.h>
int servoPin_1=5,servoPin_2=6,servoPin_3=7;
Servo servo1,servo2,servo3;
//
#include <Stepper.h>
#define STEPS 2037
Stepper stepper(STEPS,8,10,9,11);
//
int echo=2,trig=4;
//
int cnt=0;
//
void setup(){
stepper.setSpeed(12);
pinMode(trig,OUTPUT); pinMode(echo,INPUT);
servo1.attach(servoPin_1); servo1.write( 0); //CATCH
servo2.attach(servoPin_2); servo2.write( 45); //ROBOT ARM Y AXIS
servo3.attach(servoPin_3); servo3.write(150); //ROBOT ARM X AXIS
}
void loop(){
digitalWrite(trig,1); delayMicroseconds(10); digitalWrite(trig,0);
unsigned long duration=pulseIn(echo,HIGH);
float distanceCM=((34000*duration)/1000000)/2;
//
if(distanceCM <=10){
if(cnt>=10){ stepper.step(STEPS); servo2.write(120); delay(2000); }
else { cnt+=2; }
}
else{
if(cnt)cnt--;
}
//
delay(100);
}
//
코드에는 문제점이 안보이고요
5V 전원장치 전류가 부족한 가 봅니다.
//
시리얼모니터를 연결해서 (코드도 추가)
시리얼모니터에 거리값을 출력하세요
//
전원장치 변경하기 전에
스텝모터 연결을 빼고 리더기를 연결해서 돌려보세요
전류 문제라면 스텝모터는 동작하지 않겠지만 다른 것들은 정상적으로 동작해야 합니다.
- BASIC4MCU 작성글 SNS에 공유하기
댓글 0
조회수 1,315등록된 댓글이 없습니다.