질문게시판 > Atmega 128 PSD 센서와 초음파센서.

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

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


BASIC4MCU | 질문게시판 | Atmega 128 PSD 센서와 초음파센서.

페이지 정보

작성자 초심자2 작성일2019-01-25 11:05 조회8,880회 댓글4건

본문

	

안녕하세요.

 

학교에서 프로젝트를 진행중인데 아이디어가 제대로 떠오르질 않아 질문 남깁니다.

 

현재 실내 자율주행카트를 개발중인데, 총 16개 PSD센서를 ATMEGA와 모터드라이버를 통하여 구현하였습니다.

 

차체는 원형 기둥이가 절반을 나누었을 때 전반부 좌측 과 우측에 각각 8개의 psd센서를 부착하여 장애물 회피기동을 구현하였습니다.

 

여기에 추가적으로 초음파센서를 통해 복도에서 중앙으로 주행하게 하고 싶어서 약 2개~5개의 초음파센서를 추가하고 싶은데,,

 

기본 주행을 초음파센서를 베이스로하고 장애물을 만났을 때, PSD 센서 바탕의 장애물 회피기동을 실현하고 장애물이 없어지면 원래의 초음파 센서주행으로 하고 싶은데,, 

 

보통 초음파센서를 사용 할때 delay도 필요하고 코드상으로 구현할 때 인터럽트를 사용하던데,, 어떤 방식으로 코드를 구현하여야 좋을까요??

 

조언부탁드립니다 ㅠㅠ

 

현재 이 사이트의 (참고 : https://www.basic4mcu.com/bbs/board.php?bo_table=p2&wr_id=42sji) 를 참고하여 구현하였습니다. 다섯개의 초음파 센서를 사용함을 가정하고 하였는데, 잘 동작이 되질 않아서,,,

 

양쪽 벽만 볼수있게 두개로 줄일 예정입니다.

 

/*******************************************************************

trig : PF0, PF1, PF2, PF3, PF4

echo : PD0, PD1, PE5, PE6, PE7

int : INT0, INT1, INT5, INT6, INT7

참고 : https://www.basic4mcu.com/bbs/board.php?bo_table=p2&wr_id=42

sji

********************************************************************/

 

#define  F_CPU 16000000UL // 16 MHz

#include <avr/io.h>

#include <util/delay.h> 

#include <avr/interrupt.h>

#include <stdio.h>

#include "UART.h"

#include "delay_timer2.h"

#include "Motor.h"

#include "timer3_pwm.h"

#include "avr_lcd_1602_4bit.h"

#include "delay_u_mSec.h" 

#include "PSD.h"

//

volatile unsigned int  buf[5],dist[5],start=0,end=0;

volatile unsigned char cnt=0,flag[5]={0,};

 

void SCI_OutChar(char letter){ 

   // 이 예는 UART를 표준 출력 장치로 사용 하는 예 이다.

    // 아래 함수를 다른 장치로 문자를 출력 하는 함수로 바꾸면 

   // 다른 장치를 표준 출력 장치로 사용 할 수 있다.   

   //tx0_char(letter);

}

void SCI_OutUDec(unsigned short n){

  if(n >= 10){

    SCI_OutUDec(n / 10);  // Recursive Operation

    n = n % 10;

  }

  SCI_OutChar(n + '0');   // n(0-9)을 문자('0' - '9')로 변환 한다.

}

//

 

ISR(INT0_vect){ if(EICRA==0x03){start=TCNT1; buf[0] = 870;} else{ end=TCNT1; buf[0]=end-start; EIMSK=0; flag[0]=1; } EICRA^=0x01; }

ISR(INT1_vect){ if(EICRA==0x0C){start=TCNT1; buf[1] = 870;} else{ end=TCNT1; buf[1]=end-start; EIMSK=0; flag[1]=1; } EICRA^=0x04; }

ISR(INT5_vect){ if(EICRB==0x0C){start=TCNT1; buf[2] = 870;} else{ end=TCNT1; buf[2]=end-start; EIMSK=0; flag[2]=1; } EICRB^=0x04; }

ISR(INT6_vect){ if(EICRB==0x30){start=TCNT1; buf[3] = 870;} else{ end=TCNT1; buf[3]=end-start; EIMSK=0; flag[3]=1; } EICRB^=0x10; } 

ISR(INT7_vect){ if(EICRB==0xC0){start=TCNT1; buf[4] = 870;} else{ end=TCNT1; buf[4]=end-start; EIMSK=0; flag[4]=1; } EICRB^=0x40; }

 

// 870은 실험을 통해 얻어낸 수치로 buf배열 초기화.

ISR(TIMER1_COMPA_vect){   

    switch(cnt){

      case 0: PORTF|=0x01; _delay_us(10); PORTF&=~0x01; EICRA=0x03; EICRB=0x00; EIFR=0xFF; EIMSK=0x01; break;

      case 1: PORTF|=0x02; _delay_us(10); PORTF&=~0x02; EICRA=0x0C; EICRB=0x00; EIFR=0xFF; EIMSK=0x02; break;

      case 2: PORTF|=0x04; _delay_us(10); PORTF&=~0x04; EICRA=0x00; EICRB=0x0C; EIFR=0xFF; EIMSK=0x20; break;

      case 3: PORTF|=0x08; _delay_us(10); PORTF&=~0x08; EICRA=0x00; EICRB=0x30; EIFR=0xFF; EIMSK=0x40; break;

      case 4: PORTF|=0x10; _delay_us(10); PORTF&=~0x10; EICRA=0x00; EICRB=0xC0; EIFR=0xFF; EIMSK=0x80; break;

    }

    if(++cnt>4)cnt=0;

}

//

void sonar_init(void)

{   

    DDRD &= ~(0x03);

    DDRF|=0xFF; // 트리거

    TCCR1B=0x0C; OCR1A=3124; TIMSK=0x10; //16000000/256/(1+ 3124)=20Hz=50ms

    SREG=0x80;

}

void sonar(){

 

      OCR1A = PWM_Max; //왼

      OCR1B = PWM_Max; //오

//      SCI_OutChar('F');

//      SCI_OutChar(' ');

      LCD_Clear();

    

 

            

      SCI_OutChar('a');SCI_OutUDec(buf[0]*8/29);

      LCD_OutChar('a');LCD_OutUDec(buf[0]*8/29);

 

      SCI_OutChar('b');SCI_OutUDec(buf[1]*8/29);

      LCD_OutChar('b');LCD_OutUDec(buf[1]*8/29);

      

      SCI_OutChar('c');SCI_OutUDec(buf[2]*8/29);

      LCD_OutChar('c');LCD_OutUDec(buf[2]*8/29);

   

      SCI_OutChar('d');SCI_OutUDec(buf[3]*8/29);

      LCD_OutChar('d');LCD_OutUDec(buf[3]*8/29);

      

      SCI_OutChar('e');SCI_OutUDec(buf[4]*8/29);

      LCD_OutChar('e');LCD_OutUDec(buf[4]*8/29);

 

      SCI_OutChar(' ');

      LCD_SetCsr(2,1);

      

 

if ((float)buf[0]*8/29>239) //우회전 코너 상황

{

   LCD_OutChar('C');

//   if( (float)buf[2]*8/29 < 50 ){Left4();LCD_OutChar('R');}

   if( (float)buf[1]*8/29 <100) {MotorGoFoward();LCD_OutChar('F');} //문방지

   

   else {

         Right4();LCD_OutChar('T');LCD_OutChar('R');

        }

}

else if ((float)buf[4]*8/29>239) //좌회전 코너 상황

{

   LCD_OutChar('C');

//   if( (float)buf[2]*8/29 < 50 ){Right4();LCD_OutChar('L');}

   if( (float)buf[3]*8/29 < 100) {MotorGoFoward();LCD_OutChar('F');} //문방지

   

   else {

         Left4();LCD_OutChar('T');LCD_OutChar('L');

         }

}

 

else if ( ((float)buf[0]*8/29>239) && ((float)buf[1]*8/29>239) && ( ((float)buf[4]*8/29>170) && ((float)buf[3]*8/29>170)) ) //우측 난간 방지

   Left4();

   LCD_OutChar('L');LCD_OutChar('L');LCD_OutChar('L');LCD_OutChar('L');LCD_OutChar('L');LCD_OutChar('L');

   SCI_OutChar('L');SCI_OutChar('L');SCI_OutChar('L');SCI_OutChar('L');SCI_OutChar('L');SCI_OutChar('L');

      

}

 

else if ( ((float)buf[4]*8/29>239) && ((float)buf[3]*8/29>239) && ( ((float)buf[0]*8/29>170) && ((float)buf[1]*8/29>170)) ) //좌측 난간 방지

   Right4();

   LCD_OutChar('R');LCD_OutChar('R');LCD_OutChar('R');LCD_OutChar('R');LCD_OutChar('R');LCD_OutChar('R');

   SCI_OutChar('R');SCI_OutChar('R');SCI_OutChar('R');SCI_OutChar('R');SCI_OutChar('R');SCI_OutChar('R');

}


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

댓글 4

조회수 8,880

master님의 댓글

master 작성일

왼쪽메뉴 센서 아래에 초음파센서 게시판의 글을 참고하세요

초심자2님의 댓글

초심자2 댓글의 댓글 작성일

초음파센서를 인터럽트 방식으로 사용하는게 맞는 방법인가요?

master님의 댓글

master 댓글의 댓글 작성일

폴링으로 충분하면 인터럽트 쓸 필요가 없겠죠?
폴링으로 먼저 만들어서 돌려보고
문제가 생길 때에 인터럽트를 고려해보세요

초심자2님의 댓글

초심자2 댓글의 댓글 작성일

친절한 답변 감사합니다^^

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

MCU, AVR, 아두이노 등 전자공학에 관련된 질문을 무료회원가입 후 작성해주시면 전문가가 답변해드립니다.
ATMEGA128PWMLED초음파
아두이노AVR블루투스LCD
UART모터적외선ATMEGA
전체 스위치 센서
질문게시판 목록
제목 작성자 작성일 조회
공지 MCU, AVR, 아두이노 등 전자공학에 관련된 질문은 질문게시판에서만 작성 가능합니다. 스태프 19-01-15 9689
공지 사이트 이용 안내댓글[24] master 17-10-29 29814
질문 마이크로칩 스튜디오 코드 해석 새글 최선을다하자 00:08 11
질문 적외선 거리 센서로 블루투스 알람 설정 코딩... 새글 ededed 22-05-26 12
질문 아두이노 api 질문댓글[1] 새글첨부파일 리니어 22-05-26 16
질문 atmega128 키패드 입력 오류에 대하여 질문 있습니다.댓글[2] 새글 마프하나 22-05-26 42
질문 초음파센싱을 통한 리니어벨트 (스텝모터사용) 조건문댓글[1] 새글 아두이노대학 22-05-26 17
질문 아트메가128/ srf05 초음파센서를 이용한 타이머 인터럽트 질문입니다 새글 아트메가넘어려워 22-05-26 20
답변 답변글 답변 : 아트메가128/ srf05 초음파센서를 이용한 타이머 인터럽트 질문입니다 새글 master 22-05-26 20
질문 atmega128에서 스위치1개는LED, 스위치 1개는 세그먼트의 동작하게 하려는데.. 새글 aasdw 22-05-26 35
답변 답변글 답변 : atmega128에서 스위치1개는LED, 스위치 1개는 세그먼트의 동작하게 하려는데..댓글[1] 새글 master 22-05-26 25
질문 Atmega128 블루투스 오류 질문 새글 yhj2644 22-05-26 25
답변 답변글 답변 : Atmega128 블루투스 오류 질문 새글 master 22-05-26 20
질문 아두이노 간단한 프로그램 새글 행복지수업 22-05-25 26
답변 답변글 답변 : 아두이노 간단한 프로그램 새글 master 22-05-26 15
질문 atmega128 타이머 작성시 키패트 입력으로 인터럽트 사용에 대하여 질문이 있습니다.댓글[1] 이미지새글 마프하나 22-05-25 39
질문 로드셀 무게 센서 질문드립니다.댓글[2] 새글 제비고기 22-05-25 38
질문 adc, uart dma댓글[3] 새글첨부파일 hiㅡO3O 22-05-25 27
질문 ADC,uart DMA댓글[1] 이미지새글첨부파일 hiㅡO3O 22-05-25 31
질문 아두이노 스텝모터 리미트 문의드립니다.댓글[4] 이미지첨부파일 스트렌져 22-05-24 43
질문 진동센서와 서보모터 연결 코드 질문입니다!댓글[1] 제리 22-05-24 29
질문 atmega128 GPS,블루투스 질문드립니다.댓글[1] 코딩초보1 22-05-24 42
질문 서보모터 제어에 관하여 궁금합니다댓글[3] 이미지첨부파일 오소로롯 22-05-24 60
질문 atmega 128 타이머 작성 중 질문 드립니다.댓글[8] 이미지 마프하나 22-05-23 81
질문 아두이노와 휴대폰을 HC-06으로 연결시켜서 블루투스연결이 끊기면 부저에서 소리가 나게 할려하는데 어떻게 해…댓글[1] 졸작부수다 22-05-23 253
답변 답변글 답변 : 아두이노와 휴대폰을 HC-06으로 연결시켜서 블루투스연결이 끊기면 부저에서 소리가 나게 할려하는데 … master 22-05-24 35
질문 보드레이트 질문댓글[1] 죠르디 22-05-23 37
질문 atmega 128 블루투스 질문 입니다댓글[1] yhj2644 22-05-23 58
질문 아트메가 공부중에 질문있습니다..댓글[1] suid82 22-05-23 44
질문 Atmega128 UART통신 echo 반복 질문댓글[2] ming2ming 22-05-23 66
게시물 검색

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