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

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

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


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

페이지 정보

작성자 소소행 작성일2022-11-29 20:11 조회1,148회 댓글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

조회수 1,148

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
전체 스위치 센서
질문게시판 목록
제목 작성자 작성일 조회
질문 Atmega128 온도센서로 led제어 질문드려요 이미지새글첨부파일 얍얍 23-06-05 17
질문 라즈베리파이에 풀 프레임 이미지센서 활용에 대한 질문이 있습니다. 이미지새글첨부파일 KYLO 23-06-04 17
질문 stm32f767을 이용해서 자이로가속도 센서의 값 받아오기 rlchwjswk 23-06-03 20
질문 atmega128 디지털조도센서 코드오류댓글[1] 이미지 까미 23-06-02 38
질문 atmega128 디지털 조도 센서댓글[1] 까미 23-06-02 39
질문 초음파 센서를 이용한 인원 카운팅댓글[1] 초음파야 23-05-31 35
질문 THC-Soil Sensor with TTL 모듈 아두이노 센서값 받아오기댓글[1] ppiickle 23-05-30 31
질문 stm32 psd센서구동 질문댓글[2] 수포자 23-05-29 30
질문 아두이노 mq3 센서 여러개댓글[5] keyest 23-05-26 49
질문 마그네틱 도어센서 관련 질문드립니다. 엉아 23-05-23 44
답변 답변글 답변 : 마그네틱 도어센서 관련 질문드립니다.댓글[1] master 23-05-24 33
답변 답변글 답변 : 답변 : 마그네틱 도어센서 관련 질문드립니다. master 23-05-24 40
질문 토양습도센서 이용시LCD 오류댓글[5] 윤던 23-05-23 64
질문 ATMEGA 광센서 부저댓글[2] 코딩 23-05-23 62
질문 mpu 6050 과 gps 센서 질문댓글[1] Mick 23-05-05 102
질문 온도 센서 오류댓글[1] 핸찌니 23-05-03 102
질문 여러센서 아두이노 연결관련 코드 핸찌니 23-04-29 102
질문 아두이노 프로젝트 - 여러센서연결문의댓글[6] 이미지 핸찌니 23-04-27 412
질문 아두이노 초음파센서와 HC06(블루투스)를 이용, 릴레이동작댓글[3] 나도할수있어아두 23-04-27 287
질문 아두이노에 이산화탄소 센서 여러개 연결방법댓글[1] 생물공학도 23-04-14 214
질문 tcs34725(컬러센서)와 dc모터 구동댓글[2] robot2cher 23-04-12 228
질문 자이로 센서 사용하는데 질문있습니다.댓글[2] 뉴비에오 23-04-10 289
질문 아두이노 근접센서 led제어댓글[1] 김민종 23-04-05 355
질문 아두이노 근접센서 2개 연결 질문댓글[1] 김민종 23-03-29 314
질문 초음파센서를 이용한 모터제어 질문있습니다.댓글[3] 이미지첨부파일 뉴비에오 23-03-24 671
질문 atmega128 압력센서 관련 질문입니다댓글[1] 공린이 23-03-19 509
질문 가스 센서를 쓰려면댓글[3] 테스터 23-02-08 758
질문 Ozone 2 click 센서를 쓰려고하는데댓글[1] 라칸 23-02-07 416
질문 ULPSM 센서의 bias 용도댓글[3] 이미지 라칸 23-02-02 764
질문 미세먼지 센서를 해보는데댓글[3] 라칸 23-01-30 826
게시물 검색

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