질문게시판 > atmega128 서보모터와 초음파센서

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

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


BASIC4MCU | 질문게시판 | atmega128 서보모터와 초음파센서

페이지 정보

작성자 tmiae 작성일2022-05-20 12:53 조회970회 댓글5건

본문

	

안녕하세요 

atmega128을 사용하여 초음파센서에서 읽는 거리를 측정해 서보모터를 동작 중입니다.

현재 초음파센서는 HC-SR04를 이용하고 있으며 서보모터는 SG-90을 사용중입니다.

50CM 이하일 때 서보모터가 좌우로 동작하고 그 외에는 멈추는 코드를 짜고 있는데

동작이 되지않아 문의드립니다.

 

#include <avr/io.h>

#define F_CPU 16000000UL

#include <util/delay.h>

#define  TRIG  6

#define  ECHO  7

#define  SOUND_VELOCCITY 340UL

unsigned char i;

 

 

unsigned int cal_distance() //장애물까지의 거리 계산

{

unsigned distance;

TCCR1B = 0x03;

PORTB &= ~(1<<TRIG);

_delay_us(10);

PORTB |= (1<<TRIG);

_delay_us(10);

PORTB &= ~(1<<TRIG);

while(!(PIND& (1<<ECHO)));

TCNT1=0x0000;

while (PIND & (1<<ECHO));

TCCR1B = 0x00;

distance = (unsigned int)(SOUND_VELOCCITY * (TCNT1*4/2) /1000);

return(distance);

}

 

void servoStop()

{

TCCR3A &= ~((1<<COM3A1) | (1<<COM3A0));

}

 

int main(void)

{

unsigned int distance;

DDRE|= 0x08;

PORTE|= 0x08;

DDRB =DDRB|(1<<TRIG);

DDRD= DDRD|~(1<<ECHO);

TCCR3A=0x82;

TCCR3B=0x1b;

ICR3 =4999; //TOP

while(1)

{

distance=cal_distance();

if(distance < 500)

{

OCR3A=125; //0도

_delay_ms(500);

OCR3A=375; //90도

_delay_ms(500);

OCR3A=625; //180도

_delay_ms(500);

}

else

{

servoStop();

}

}

}

 

 

 

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

댓글 5

조회수 970

master님의 댓글

master 작성일

ICR3 =4999; //TOP
0.5us*5000=2500us
일반 서보모터는 20ms 주기로 만들어야 합니다.
2.5ms는 너무 짧죠
RC용 일부 서보모터는 고속응답을 하기 위해서 짧은 주기를 사용하기도 합니다.
ICR3 =39999; //TOP
0.5us*40000=20000us=20ms

master님의 댓글

master 작성일

while(1){
OCR3A=125; _delay_ms(500); //0도
OCR3A=375; _delay_ms(500); //90도
OCR3A=625; _delay_ms(500); //180도
}
}

ICR3을 수정했다면 무한루프를 이렇게 수정해서 돌리면 서보모터가 좌우로 반복하겠죠
이 때도 안 돌아간다면 서보 전원의 전류 부족인지 체크하세요

tmiae님의 댓글

tmiae 댓글의 댓글 작성일

빌드는 되는데 동작을 안하는거 보니 아무래도 전류부족인거 같습니다.
트랜지스터를 연결해서 다시 동작시켜보겠습니다.
감사합니다.

master님의 댓글

master 작성일

DDRB =DDRB|(1<<TRIG);
DDRD= DDRD|~(1<<ECHO);
트리거는 맞는데 에코가 잘못되었습니다.
DDRD= DDRD&~(1<<ECHO);
입력은 없어도 전원 리셋 후 디폴트 입력이라서 안 적어도 되는데, 괜히 적어서 다른 핀을 모두 출력으로 만드는 군요

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

MCU, AVR, 아두이노 등 전자공학에 관련된 질문을 무료회원가입 후 작성해주시면 전문가가 답변해드립니다.
ATMEGA128PWMLED초음파
아두이노AVR블루투스LCD
UART모터적외선ATMEGA
전체 스위치 센서
질문게시판 목록
제목 작성자 작성일 조회
공지 MCU, AVR, 아두이노 등 전자공학에 관련된 질문은 질문게시판에서만 작성 가능합니다. 스태프 19-01-15 10803
공지 사이트 이용 안내댓글[25] master 17-10-29 30635
질문 Atmega IO핀 출력 상태 질문이요..댓글[3] 새글 chelsea 22-07-06 20
답변 답변글 답변 : Atmega IO핀 출력 상태 질문이요..댓글[6] 새글 master 22-07-06 18
질문 아두이노 센서 쉴드 v5.0 과 음성인식 모듈(V2)통신댓글[6] 이미지새글첨부파일 AutoSun 22-07-05 26
질문 초음파 센서를 사용한 dc모터 제어에 관해 질문 있습니다. 첨부파일 뉴비에오 22-07-04 38
답변 답변글 답변 : 초음파 센서를 사용한 dc모터 제어에 관해 질문 있습니다.댓글[2] 새글 master 22-07-05 34
질문 아두이노 Sensor Shield 5.0 시리얼 통신 질문댓글[2] AutoSun 22-07-04 53
질문 Atmega 코드 좀 봐주세요.댓글[1] 첨부파일 chelsea 22-07-04 49
질문 아두이노 while문 탈출 질문 yhj2644 22-07-01 105
답변 답변글 답변 : 아두이노 while문 탈출 질문댓글[8] master 22-07-01 131
질문 ESP32-C3 리튬폴리머 ADC 전압 체크 관련 문의 (2)댓글[3] 이미지 cansad 22-06-30 100
질문 ESP32-C3 리튬폴리머 ADC 전압 체크 관련 문의댓글[3] cansad 22-06-30 146
질문 빵판없이 디스플레이 넣을 수 있을까요?댓글[2] 이미지첨부파일 오소로롯 22-06-29 107
질문 라즈베리파이4 신형 선택문제댓글[1] maximum 22-06-26 171
질문 음전압 ADC댓글[2] 412904 22-06-26 173
질문 아두이노 센서값 출력 질문입니다!댓글[1] 아궁2 22-06-24 197
질문 ATmega128, ATmega28 RS232통신 이미지첨부파일 Moon4201 22-06-24 219
답변 답변글 답변 : ATmega128, ATmega28 RS232통신댓글[1] master 22-06-25 208
질문 서보모터, 온습도센서 코드 질문댓글[2] 첨부파일 kshdlfaldfh 22-06-22 164
답변 답변글 답변 : 서보모터, 온습도센서 코드 질문댓글[15] master 22-06-22 428
질문 steppermulti5 질문 응애 22-06-21 128
답변 답변글 답변 : steppermulti5 질문댓글[1] master 22-06-22 109
질문 atmega128 avr usart 질문 snoflak 22-06-21 179
답변 답변글 답변 : atmega128 avr usart 질문댓글[5] master 22-06-21 340
질문 사용자 정의 함수 변환 하는 방법댓글[2] 이미지첨부파일 da0800 22-06-21 145
질문 atmega128댓글[1] 이미지 양의노래 22-06-20 204
질문 아두이노 동시동작 재질문댓글[9] 이미지첨부파일 죠르디 22-06-20 348
질문 초음파센서로 dc모터 제어하기댓글[1] 첨부파일 난쟁2 22-06-20 214
질문 아두이노 동시동작댓글[7] 죠르디 22-06-19 220
게시물 검색

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