while(1)
{
if(flag==0)
{
if(start == 0)
{
// P0 = 0xfd; //正轉(zhuǎn)1個(gè)角度
SETP_MOTOR1_FFW(N1);//qian jin
SETP_MOTOR2_FFW(N2);//qian jin
SETP_MOTOR3_FFW(N3);//qian jin
SETP_MOTOR4_FFW(N4);//qian jin
start=1;
DelayMS(1000);
}
else if(start == 1)
{
//反轉(zhuǎn)1個(gè)角度
SETP_MOTOR1_REV(N1);//qian jin
SETP_MOTOR2_REV(N2);//qian jin
SETP_MOTOR3_REV(N3);//qian jin
SETP_MOTOR4_REV(N4);//qian jin