Page 1070 - 3-3

{
while(PIND.7 != 0);
}

void F1_qrd() //1 층 QRD 신호 대기 함수
{
while (PINB.2 != 0);
delay_ms(500);
}

void F2_1_qrd() //2 층 White QRD 신호 대기 함수
{
while (PINB.3 != 0);
}

void F2_2_qrd() //2 층 Blue QRD 신호 대기 함수
{
while (PINB.4 != 0);
}

void F3_Micro() //3 층 마이크로 스위치
{
while (PINB.5 != 0);
}

void W1_out() //W1 에서 플레이트를 꺼내는 함수
{
PORTA.0 = 0; //set relay low
PORTA.6 = 0; //set relay low
PORTF = 0x41; //motor operate
Infrared(); // 엘리베이터 qrd 신호 대기
PORTF = 0x00; //motor stop
}

void W2_out() //W2 에서 플레이트를 꺼내는 함수
{
PORTA.1 = 0; //set relay low
PORTA.6 = 0; //set relay low
PORTF = 0x42; //motor operate
Infrared(); // 엘리베이터 qrd 신호 대기
PORTF = 0x00; //motor stop
}

void W3_out() //W3 에서 플레이트를 꺼내는 함수
{

- 1070 -