질문게시판 > 초음파 센서3개와 스텝 모터연결 , 스텝모터가 안 돌아요ㅜㅜ

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

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


BASIC4MCU | 질문게시판 | 초음파 센서3개와 스텝 모터연결 , 스텝모터가 안 돌아요ㅜㅜ

페이지 정보

작성자 소소행 작성일2022-11-29 20:11 조회631회 댓글1건

본문

	

초음파 센서 3개를 연결해서 3개 중 하나라도 장애물이랑 가까워지면 스텝모터가 거리에 반비례해서 빨리 돌아가게하는 코딩을 해봤는데 시리얼모니터에는 값들이 잘 나오는데 스텝 모터가 진동만 있고 안 돌아가네요 변수문제인가요ㅜㅜ 알려주시면 감사하겠습니다!

 

#include <NewPing.h>

 

//sonar(TrigPin, EchoPin, MaxDistance);

NewPing sonar[3] = { 

  NewPing(2, 3, 200), 

  NewPing(4, 5, 200),

  NewPing(6, 7, 200),

};

 

// 스텝 모터 신호핀 설정

int motorPin1 = 8;

int motorPin2 = 9;

int motorPin3 = 10;

int motorPin4 = 11;

 

// 모터 속도 관련 변수 설정

int motorSpeed; // 스텝 사이의 지연시간으로서 4500~1000의 범위를 갖는다. 

int motorSpeedPercent; // 속도를 0~100%로 나타낸다.

 

// 스텝 모터의 스텝 설정

// 0~7은 동작 신호, 8번째는 모터 정시지 신호

int steps[] = {B1000, B1100, B0100, B0110, B0010, B0011, B0001, B1001, B0000};

 

 

void setup() {

  Serial.begin(9600);

  pinMode(motorPin1, OUTPUT);

  pinMode(motorPin2, OUTPUT);

  pinMode(motorPin3, OUTPUT);

  pinMode(motorPin4, OUTPUT);

}

 

void clockwise(){

  // 7~0 번째 신호를 순차적으로 출력시킨다.

  for(int i = 7; i >= 0; i--)

  {

    motorSignalOutput(i);

    delayMicroseconds(motorSpeed);

  }

}

 

void motorStop(){

  // 정지신호를 출력시킨다.

  motorSignalOutput(8); 

}

 

void motorSignalOutput(int out)

{

  // out 변수에 해당하는 모터 시그날을 출력한다.

  digitalWrite(motorPin1, bitRead(steps[out], 0));

  digitalWrite(motorPin2, bitRead(steps[out], 1));

  digitalWrite(motorPin3, bitRead(steps[out], 2));

  digitalWrite(motorPin4, bitRead(steps[out], 3));

}

 

void loop() {

  delay(50);          

  Serial.print("A Ping : ");

  Serial.print(sonar[0].ping_cm());

  Serial.println("cm");

   

  delay(50);          

  Serial.print("B Ping : ");

  Serial.print(sonar[1].ping_cm());

  Serial.println("cm");

 

  delay(50);          

  Serial.print("C Ping : ");

  Serial.print(sonar[2].ping_cm());

  Serial.println("cm");

  

  delay(500);

 

 

  int distance1 = sonar[0].ping_cm();

  int distance2 = sonar[1].ping_cm();

  int distance3 = sonar[2].ping_cm();

 

  // CW로 회전시 모터를 CW방향으로 회전시킨다.

  if( distance1 <= 90){

    //모터의 속도를 계산한다.

    motorSpeed = map(distance1,90,0,4500,1000);

    // 모터의 속도를 백분율로 변환시킨다.

    motorSpeedPercent = map(motorSpeed,4500,1000,1,100);

    // 시리얼 통신 메세지를 출력한다.

    Serial.print("CW Motor Speed: ");

    Serial.print(motorSpeedPercent);

    Serial.println("%");        

    // CW로 회전시킨다.

    clockwise();

  }

 

  else if( distance2 <= 90){

    //모터의 속도를 계산한다.

    motorSpeed = map(distance2,90,0,4500,1000);

    // 모터의 속도를 백분율로 변환시킨다.

    motorSpeedPercent = map(motorSpeed,4500,1000,1,100);

    // 시리얼 통신 메세지를 출력한다.

    Serial.print("CW Motor Speed: ");

    Serial.print(motorSpeedPercent);

    Serial.println("%");        

    // CW로 회전시킨다.

    clockwise();

  } 

 

  else if( distance3 <= 90){

    //모터의 속도를 계산한다.

    motorSpeed = map(distance3,90,0,4500,1000);

    // 모터의 속도를 백분율로 변환시킨다.

    motorSpeedPercent = map(motorSpeed,4500,1000,1,100);

    // 시리얼 통신 메세지를 출력한다.

    Serial.print("CW Motor Speed: ");

    Serial.print(motorSpeedPercent);

    Serial.println("%");        

    // CW로 회전시킨다.

    clockwise();

  }

 

  else{

    Serial.println("Motor Stop");

    motorStop();

  }

}

  • BASIC4MCU 작성글 SNS에 공유하기
  • 페이스북으로 보내기
  • 트위터로 보내기
  • 구글플러스로 보내기

댓글 1

조회수 631

master님의 댓글

master 작성일

void motorStop(){  // 정지신호를 출력시킨다.
  motorSignalOutput(8);
}
정지는 아무런 출력도 하지 않는 것이 정지입니다.
이 함수를 사용 할 필요가 없겠죠
//
    //모터의 속도를 계산한다.
    motorSpeed = map(distance1,90,0,4500,1000);
딜레이가 부족하면 진동만하고 움직이지 않을 수 있습니다.
    motorSpeed = map(distance1,90,0,30000,30000);
충분히 딜레이를 줘서 동작하는 것을 확인하고 , 그 후에 값을 줄여서 정상동작하는 딜레이 값을 찾아보세요
//
모터 전압이나 전류가 부족한 경우에도 진동만하고 회전하지 못하기도 합니다.
//
모터 토크에 비해서 부하가 큰 경우에도 진동만하고 회전하지 못하기도 합니다.

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

MCU, AVR, 아두이노 등 전자공학에 관련된 질문을 무료회원가입 후 작성해주시면 전문가가 답변해드립니다.
ATMEGA128PWMLED초음파
아두이노AVR블루투스LCD
UART모터적외선ATMEGA
전체 스위치 센서
질문게시판 목록
제목 작성자 작성일 조회
질문 아두이노 근접센서 2개 연결 질문댓글[1] 김민종 23-03-29 27
질문 초음파센서를 이용한 모터제어 질문있습니다.댓글[3] 이미지첨부파일 뉴비에오 23-03-24 79
질문 atmega128 압력센서 관련 질문입니다댓글[1] 공린이 23-03-19 95
질문 가스 센서를 쓰려면댓글[3] 테스터 23-02-08 298
질문 Ozone 2 click 센서를 쓰려고하는데댓글[1] 라칸 23-02-07 208
질문 ULPSM 센서의 bias 용도댓글[3] 이미지 라칸 23-02-02 321
질문 미세먼지 센서를 해보는데댓글[3] 라칸 23-01-30 318
질문 가스 센서 공식댓글[2] 이미지첨부파일 풀이싫은초식동물 23-01-27 294
질문 adc값 가지고 센서 측정값을 찾고 싶은데댓글[2] 라칸 23-01-25 316
질문 님들 센서 측정값 계산식 찾는법좀댓글[2] 라칸 23-01-13 311
질문 아두이노 a4988 스텝모터 + LCD 모니터 + 미세먼지 센서 (GP2Y1014AU0F) 이미지 JCHJ 22-12-15 370
답변 답변글 답변 : 아두이노 a4988 스텝모터 + LCD 모니터 + 미세먼지 센서 (GP2Y1014AU0F)댓글[2] master 22-12-15 660
질문 atmega128 온도센서, 광센서, led2개, 스위치, 스피커 사용댓글[1] 졸업만도아주세윰 22-12-14 605
질문 아두이노 심박센서 및 LCD로 BPM나타내기 질문있습니다.댓글[2] 이미지첨부파일 공백 22-12-12 694
질문 Atmeg128a, 초음파센서, 서보모터 코드댓글[2] 전가스 22-12-12 725
질문 atmega128 초음파 센서 신장 측정 가나다라 22-12-12 378
답변 답변글 답변 : atmega128 초음파 센서 신장 측정 master 22-12-12 359
질문 도움이 필요합니다.. 충격감지 센서 연결댓글[1] 알쓰리 22-12-11 340
질문 atmega128 온도센서 질문입니다. 으아어려워 22-12-10 329
답변 답변글 답변 : atmega128 온도센서 질문입니다.댓글[1] master 22-12-10 424
질문 아두이노와 초음파 센서로 모터 제어 코드 질문있습니다. blackbunn 22-12-07 389
답변 답변글 답변 : 아두이노와 초음파 센서로 모터 제어 코드 질문있습니다.댓글[1] master 22-12-07 497
질문 온습도 센서와 L9110 FAN Module 모터구동 질문있습니다!!댓글[2] 진현 22-12-04 494
질문 2개의 초음파센서로 서보모터 하나 작동댓글[2] 이미지첨부파일 승천 22-12-03 570
답변 답변글 답변 : 2개의 초음파센서로 서보모터 하나 작동댓글[1] master 22-12-03 367
질문 초음파센서코드와 조도센서코드 합성하는 중입니다.댓글[4] 잉뚜 22-12-02 939
질문 아두이노 코딩을 바탕으로 atmega 128수위센서를 만들고 싶습니다.댓글[1] atmegaga123 22-12-01 605
질문 아두이노 특정 상황에서 초음파 센서가 작동을 안하는거 같습니다. KMMS 22-12-01 480
답변 답변글 답변 : 아두이노 특정 상황에서 초음파 센서가 작동을 안하는거 같습니다. master 22-12-01 537
질문 아두이노 화재센서 블루투스 연동 질문드립니다.댓글[1] 원할머니보고쌈 22-11-29 711
게시물 검색

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
모바일버전으로보기