Page 322 - MDP2020-3
P. 322
316
| 인천전자마이스터고등학교 ·············································································································
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에서 플레이트를 꺼내는 함수
{
PORTA.2 = 0; //set relay low
PORTA.6 = 0; //set relay low