Page 323 - MDP2020-3

················································································ 명장양성프로젝트 【MDP】 과제발표회 자료집 Ⅲ | 317

PORTF = 0x44; //motor operate
Infrared(); //엘리베이터 qrd 신호대기

PORTF = 0x00; //motor stop
}

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

PORTA.3 = 0; //set relay low
PORTA.6 = 1; //set relay high
PORTF = 0x48; //motor operate
Infrared(); //엘리베이터 qrd 신호 대기
PORTF = 0x00; //motor stop

}

void B2_out() //B2에서 플레이트를 꺼내는 함수
{
PORTA.4 = 0; //set relay low

PORTA.6 = 1; //set relay high
PORTF = 0x50; //motor operate
Infrared(); //엘리베이터 qrd 신호 대기
PORTF = 0x00; //motor stop
}

void B3_out() //B3에서 플레이트를 꺼내는 함수
{
PORTA.5 = 0; //set relay low
PORTA.6 = 1; //set relay high

PORTF = 0x60; //motor operate
Infrared(); //엘리베이터 qrd 신호 대기
PORTF = 0x00; //motor stop
}

void W1_in() //W1로 플레이트를 넣는 함수
{
PORTA.0 = 1; //set relay high
PORTA.6 = 1; //set relay high
PORTF = 0x41; //motor operate

W1_Micro(); //W1 마이크로 스위치 신호 대기
PORTF = 0x00; //motor stop
}