// MCU BASIC: https://www.basic4mcu.com
// DateTime : 2018-12-18 오후 2:54:43
// by Ok-Hyun Park
//
#include <mega128.h>
#include <stdio.h>
#include <delay.h>
//
#define Trig PORTC.0
#define Echo PINA.0
//
unsigned int getEcho(void){
  unsigned int  range;
  while(!Echo); TCNT1=0; TCCR1B=2;
  while( Echo); TCCR1B=0;
  range=TCNT1/116; // 범위cm
  return(range);
}
//
void main(void){
  unsigned int range;
  DDRB=3; // LED PB0,PB1
  DDRC=1; // TRIG PC0
  while(1){
    Trig=1; delay_us(10); Trig=0; //10us  
    range=getEcho();
    //
    if(range>5){ PORTB=1; } // 5cm이상
    else       { PORTB=2; } // 5cm이하
    delay_ms(100);
    PORTB=0;
  }
}
 
LED와 초음파 연결핀 잘 체크하세요
 
 
게시판에 소스코드 하이라이트 프로그램을 올려두었는데
공지글이 풀려서 보이지 않습니다.
 
https://cafe.naver.com/circuitsmanual/203829 
여기서 다운 받아도 됩니다.