Page 988 - 완) I MDP 프로젝트 작품 보고서(전체과 1학년)1.6

{

if(direction == 1) //순방향
{
GPIO_SetBits(GPIOB,GPIO_Pin_4);
GPIO_ResetBits(GPIOB,GPIO_Pin_5);

}
else //역방향
{
GPIO_SetBits(GPIOB,GPIO_Pin_5);
GPIO_ResetBits(GPIOB,GPIO_Pin_4);
}

}

void MS(){//모든 모터 멈춤
MSA();

MSB();
MSC();
}
void TURN_R(){//우로 회전
MA(1);
MB(1);

MC(1);
}
void TURN_L(){//좌로 회전
MA(0);

MB(0);
MC(0);
}

void goA(char d) //A방면으로 직진
{

if(d == 1)
{
MB(1);
MC(0);

MSA();
}

- 981 -