질문게시판 > 아두이노와 초음파 센서로 모터 제어 코드 질문있습니다.

TODAY826 TOTAL3,072,920
사이트 이용안내
Login▼/회원가입
최신글보기 질문게시판 기술자료 동영상강좌

아두이노 센서 ATMEGA128 PWM LED 초음파 AVR 블루투스 LCD UART 모터 적외선


BASIC4MCU | 질문게시판 | 아두이노와 초음파 센서로 모터 제어 코드 질문있습니다.

페이지 정보

작성자 blackbunn 작성일2022-12-07 15:46 조회2,040회 댓글0건

본문

	

안녕하세요 저는 아두이노와 초음파 센서, DC모터2개 를 이용하여

초음파 센서  거리별로 

물제가 감지 안되었을때 0, 멈춰있다가

50 cm 앞에 물체가 감지 되었을때 2개의 모터중 왼쪽이 작동하고, 

30cm 앞에 물체가 감지 되었을때 오른쪽이 작동하고

마지막으로 10cm 앞에 물체가 왔을때 둘다 돌아가는 장치를 만들고 있습니다.

 

모터 드라이버는 L293D 를 사용하여 연결하였고 코드를 작성하였는데 컴파일은 되지만 

원활하게 모터가 작동이 안되어 작성한 코드에 대한 수정또는 조언 부탁드리겠습니다.

 

감사합니다.

 

어래는 작성한 코드 입니다.

int trig = 3;
int echo = 4;

unsigned long duration;
unsigned long distance;

#define FORWARD 1   // 모터 정방향
#define BACKWARD 2  //모터 역방향
#define RELEASE 3   // 모터 정지

int enablePin = 5;
int motorPin1 = 7;
int motorPin2 = 6;
int motorPin3 = 9;
int motorPin4 = 8;

void setup() {

  Serial.begin(9600);

  // 초음파 인풋
  pinMode(trig, OUTPUT);
  pinMode(echo, INPUT);

  // 모터 인풋
  pinMode(enablePin, OUTPUT);
  pinMode(motorPin1, OUTPUT);
  pinMode(motorPin2, OUTPUT);
  pinMode(motorPin3, OUTPUT);
  pinMode(motorPin4, OUTPUT);
  motorMove(RELEASE);
}

void loop() {

  digitalWrite(trig, LOW);
  delayMicroseconds(2);
  digitalWrite(trig, HIGH);
  delayMicroseconds(10);
  digitalWrite(trig, LOW);
  long duration = pulseIn(echo, HIGH);
  long distance = (duration * 340) / 2 / 10000;

  if (distance <= 10) {  //10cm이내
    int spin = map(distance, 10, 0, 0, 255);
    analogWrite(motorMove, spin);
  }

  if (distance <= 30) {  //30cm 이내
    int spin = map(distance, 0, 10, 0, 255);
    analogWrite(motorMove, spin);
  }

  if (distance <= 50) {  //50cm 이내
    int spin = map(distance, 0, 10, 0, 255);
    analogWrite(motorMove, spin);
  }

  motorMove(FORWARD);
  delay(1000);

  motorMove(BACKWARD);
  delay(1000);

  motorMove(RELEASE);
  delay(1000);
}
  • BASIC4MCU 작성글 SNS에 공유하기
  • 페이스북으로 보내기
  • 트위터로 보내기
  • 구글플러스로 보내기

댓글 0

조회수 2,040

등록된 댓글이 없습니다.

질문게시판HOME > 질문게시판 목록

MCU, AVR, 아두이노 등 전자공학에 관련된 질문을 무료회원가입 후 작성해주시면 전문가가 답변해드립니다.
ATMEGA128PWMLED초음파
아두이노AVR블루투스LCD
UART모터적외선ATMEGA
전체 스위치 센서
질문게시판 목록
제목 작성자 작성일 조회
질문 스텝모터 제어 및 온도센서 값 동시 추출 질문드립니다.댓글[1] metanoia 23-12-06 37
질문 atmega128 압력센서 관해댓글[2] 메시기모찌 23-12-04 150
질문 안녕하세요 심장박동센서를 이용해 일정 심박수 이상이되면 부저 작동에 대해서 질문드립니다.댓글[8] 충전공 23-12-04 163
질문 스텝모터, 컬러센서를 이용한 아두이노댓글[3] 초식동물 23-12-02 146
질문 조도 센서를 이용하여 pwm모드로 led밝기 조절 아자자자자자 23-12-02 85
답변 답변글 답변 : 조도 센서를 이용하여 pwm모드로 led밝기 조절댓글[2] master 23-12-02 59
질문 ATMEGA 128 초음파 센서 거리에 따른 부저 작동 질문드립니다.댓글[7] 충전공 23-12-02 382
질문 ATMEGA128 초음파센서 인터럽트 관련 메시기모찌 23-12-01 125
답변 답변글 답변 : ATMEGA128 초음파센서 인터럽트 관련 master 23-12-01 232
질문 atmega128 초음파센서 인터럽트댓글[8] 메시기모찌 23-11-30 592
질문 아트메가 128 초음파센서 코드 질문입니다. gongrin 23-11-29 130
답변 답변글 답변 : 아트메가 128 초음파센서 코드 질문입니다. master 23-11-30 125
질문 적외선 센서는 감지가 되는데 적외선 센서가 감지 될때 서보모터가 동시에 동작하게 하려고 하는데 도와주시면 감… 조현호 23-11-28 235
답변 답변글 답변 : 적외선 센서는 감지가 되는데 적외선 센서가 감지 될때 서보모터가 동시에 동작하게 하려고 하는데 도와… master 23-11-29 114
질문 AD 내부 인터럽트를 이용해 조도센서를 통한 LED 제어 첨부파일 푸글릿 23-11-21 249
답변 답변글 답변 : AD 내부 인터럽트를 이용해 조도센서를 통한 LED 제어댓글[1] master 23-11-21 867
질문 질문 아두이노 - ph 센서 이용 LED 켜기댓글[2] 이미지첨부파일 잼민 23-11-20 373
답변 답변글 답변 : 질문 아두이노 - ph 센서 이용 LED 켜기 이미지 master 23-11-20 646
질문 온도센서 센서값 필터링 관련해서 질문드립니다.댓글[2] 이미지첨부파일 metanoia 23-11-09 905
질문 아두이노 센서 코딩 오류 dnjsjj 23-11-01 493
답변 답변글 답변 : 아두이노 센서 코딩 오류 master 23-11-02 695
질문 stm32에서 센서의 adc값을 읽어올때댓글[1] 이미지 라칸 23-11-01 569
질문 pir센서를 쓰려는데 디지털ouput값을댓글[5] 이미지 라칸 23-10-31 1356
질문 초음파센서 두개사용하여 물체탐지 Led댓글[1] 알려주새ㅔㅔ요ㅠ 23-10-16 851
질문 마스터 슬레이브 초음파 센서를 사용하여 RC카 제어하기댓글[1] 둘둘이 23-10-16 669
질문 아두이노 초음파센서와 서보모터 사용한 엘리베이터댓글[1] wjsdnsa 23-10-09 711
질문 아두이노 블루투스와 초음파센서를 이용한 장애물 정지댓글[2] 둘둘이 23-09-22 979
답변 답변글 답변 : 아두이노 블루투스와 초음파센서를 이용한 장애물 정지댓글[1] master 23-09-25 810
질문 아두이노와 거리 감지 센서의 전류 관련댓글[1] hmkim 23-09-21 779
질문 로드셀, 온습도센서 코드 합치기댓글[2] 생물공학도 23-08-11 1029
게시물 검색

2022년 1월 2월 3월 4월 5월 6월 7월 8월 9월 10월 11월 12월
2021년 1월 2월 3월 4월 5월 6월 7월 8월 9월 10월 11월 12월
2020년 1월 2월 3월 4월 5월 6월 7월 8월 9월 10월 11월 12월
2019년 1월 2월 3월 4월 5월 6월 7월 8월 9월 10월 11월 12월
2018년 1월 2월 3월 4월 5월 6월 7월 8월 9월 10월 11월 12월
Privacy Policy
MCU BASIC ⓒ 2020
모바일버전으로보기