TECO东元电机-东元变频器-teco东元电机股份有限公司官网

plc步進(jìn)電機(jī)正回轉(zhuǎn)程序
#include

void delayB(uchar x) //x*0.14MS
{
uchar i;
while(x--)
{
for (i=0; i<13; i++)
{ }
}
}

void beep()
{
uchar i;
for (i=0;i<100;i++)
{
delayB(4);
BEEP=!BEEP; //BEEP取反
}
BEEP=1; //封閉蜂鳴器
}

void motor_ffw()
{
uchar i;
uint j;
for (j=0; j<8; j++) //轉(zhuǎn)1*n圈
{
if(K3==0)
{break;} //退出此循環(huán)程序
for (i=0; i<8; i++) //一個(gè)周期轉(zhuǎn)45度
{
P1 = FFW[i]; //取數(shù)據(jù)
delay(2); //調(diào)度轉(zhuǎn)速
}
}
}

void motor_rev()
{
uchar i;
uint j;
for (j=0; j<8; j++) //轉(zhuǎn)1×n圈
{
if(K3==0)
{break;} //退出此循環(huán)程序
for (i=0; i<8; i++) //一個(gè)周期轉(zhuǎn)45度
{
P1 = REV[i]; //取數(shù)據(jù)
delay(2); //調(diào)度轉(zhuǎn)速
}
}
}

main()
{
uchar r,N=64; //N 步進(jìn)電機(jī)作業(yè)圈數(shù)
while(1)
{
if(K1==0)
{
beep();
for(r=0;r<N;r++)
{
motor_ffw(); //電機(jī)正轉(zhuǎn)
if(K3==0)
{beep();break;} //退出此循環(huán)程序
}
}
else if(K2==0)
{
beep();
for(r=0;r<N;r++)
{
motor_rev(); //電機(jī)回轉(zhuǎn)
if(K3==0)
{beep();break;} //退出此循環(huán)程序
}
}
else
P1 = 0xf0;
}
}