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

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

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


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

페이지 정보

작성자 tmiae 작성일2022-05-20 12:53 조회2,670회 댓글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

조회수 2,670

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
전체 스위치 센서
질문게시판 목록
제목 작성자 작성일 조회
질문 모터 엔코더 제어 질문드립니다. oreoreo 22-05-27 1361
답변 답변글 답변 : 모터 엔코더 제어 질문드립니다.댓글[1] master 22-05-27 849
질문 아두이노 RF무선통신 관련 질문입니다.댓글[3] 메론맛드링크 22-05-27 2263
질문 아두이노 속도측정, 속도를 LCD에 표시, 가까워지면 부저 wgtjdwls 22-05-27 1424
답변 답변글 답변 : 아두이노 속도측정, 속도를 LCD에 표시, 가까워지면 부저 master 22-05-27 1612
질문 블루투스 관련 코드 도와주세요 scape 22-05-27 956
답변 답변글 답변 : 블루투스 관련 코드 도와주세요 master 22-05-27 2009
질문 ATmega128 1602A LCD 출력 질문입니다.댓글[2] 444222a 22-05-27 1934
질문 ATmega128 스위치 채터링 관련 질문드립니다댓글[3] yeon 22-05-27 3000
질문 마이크로칩 스튜디오 코드 해석 최선을다하자 22-05-27 1421
답변 답변글 답변 : 마이크로칩 스튜디오 코드 해석댓글[20] master 22-05-27 4102
답변 답변글 답변 : 답변 : 마이크로칩 스튜디오 코드 해석 이미지 master 22-06-01 1040
질문 적외선 거리 센서로 블루투스 알람 설정 코딩...댓글[1] ededed 22-05-26 2444
질문 아두이노 api 질문댓글[1] 첨부파일 리니어 22-05-26 1015
질문 atmega128 키패드 입력 오류에 대하여 질문 있습니다.댓글[2] 마프하나 22-05-26 2481
질문 초음파센싱을 통한 리니어벨트 (스텝모터사용) 조건문댓글[1] 아두이노대학 22-05-26 1514
질문 아트메가128/ srf05 초음파센서를 이용한 타이머 인터럽트 질문입니다 아트메가넘어려워 22-05-26 1164
답변 답변글 답변 : 아트메가128/ srf05 초음파센서를 이용한 타이머 인터럽트 질문입니다 master 22-05-26 1362
질문 atmega128에서 스위치1개는LED, 스위치 1개는 세그먼트의 동작하게 하려는데.. aasdw 22-05-26 1676
답변 답변글 답변 : atmega128에서 스위치1개는LED, 스위치 1개는 세그먼트의 동작하게 하려는데..댓글[1] master 22-05-26 1926
질문 Atmega128 블루투스 오류 질문 yhj2644 22-05-26 1797
답변 답변글 답변 : Atmega128 블루투스 오류 질문댓글[2] master 22-05-26 2244
질문 아두이노 간단한 프로그램 행복지수업 22-05-25 1690
답변 답변글 답변 : 아두이노 간단한 프로그램 master 22-05-26 1109
질문 atmega128 타이머 작성시 키패트 입력으로 인터럽트 사용에 대하여 질문이 있습니다.댓글[1] 이미지 마프하나 22-05-25 1671
질문 로드셀 무게 센서 질문드립니다.댓글[2] 제비고기 22-05-25 2034
질문 adc, uart dma댓글[3] 첨부파일 hiㅡO3O 22-05-25 1719
질문 ADC,uart DMA댓글[1] 이미지첨부파일 hiㅡO3O 22-05-25 2119
질문 아두이노 스텝모터 리미트 문의드립니다.댓글[4] 이미지첨부파일 스트렌져 22-05-24 1212
질문 진동센서와 서보모터 연결 코드 질문입니다!댓글[1] 제리 22-05-24 1341
게시물 검색

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