Page 1068 - 3-3

{
int k;
delay_ms(500);
for (k = 0; k < 25; k++) //90[°]
{
PORTA.7 = 1;
delay_us(550);
PORTA.7 = 0;
delay_ms(20);
}
}

void Top_Motor_Up() // 상단모터로 엘리베이터 상승
{
PORTB.6 = 0; // 모터 역회전
PORTB.7 = 1;
}

void Top_Motor_Down() // 상단모터로 엘리베이터 하강
{
PORTB.6 = 1; // 모터 정회전
PORTB.7 = 0;
}
void Top_Motor_Stop() // 상단 모터를 멈춤
{
PORTB.6 = 0;
PORTB.7 = 0;
}

void Infrared() //QRD1114 적외선 센서 신호 수신 함수
{
short buffer1 = 0; // 좌측 QRD1114 신호
short buffer2 = 0; // 우측 QRD1114 신호
while1)
{
if(!buffer1) buffer1 = PINB.0; // 좌측에서 플레이트를 감지할 때 까지 반복
If(!buffer2) buffer2 = PINB.1; // 우측에서 플레이트를 감지할 때 까지 반복
if(buffer1 && buffer2) return; // 함수를 탈출
}
}

void Ready_to_Park() // 주차가 완료 될 때 까지 대기
{
while (1)
{

- 1068 -