Page 626 - 완) I MDP 프로젝트 작품 보고서(전체과 1학년)1.6
P. 626
void sonic_pulse(void) //초음파 출력 시작 신호를 보내주는 함수
{
TRIG=1;
delay_us(10);
TRIG=0;
}
void led_display(void)
{
dist=sonic_timer; //몫이 클수록 물체와 거리가 길어짐 (led bar는 적게 출력)
//M_IC &= 0xfe;
if (dist<=2) { led_bar=0x00; M_IC |= 0x01; }
else if (dist<3){led_bar=0x01; M_IC &= 0x00;}
else if (dist<4){led_bar=0x03; M_IC &= 0x00;}
else if (dist<5){led_bar=0x07; M_IC &= 0x00;}
else if (dist<6){led_bar=0x0f; M_IC &= 0x00;}
else if (dist<7) {led_bar=0x1f; M_IC &= 0x00;}
else if (dist<8) {led_bar=0x7f; M_IC &= 0x00;}
else if (dist<9) {led_bar=0x3f; M_IC &= 0x00;}
else if (dist<10) {led_bar=0xff; M_IC &= 0x00;}
delay_ms(20);
}
interrupt [USART0_RXC] void receiver(void)
{
rx=UDR0;
if(rx=='W')
{
MOTOR=0x09;//모터 전진
}
else if(rx=='A')
{
MOTOR=0x08;//모터 좌회전
}
else if(rx=='D')
{
MOTOR=0x01;//모터 우회전
}
else if(rx=='S')
- 619 -