motor.c

该程序能够实现四相六线步进电机的正反转功能

#include<pic.h>

void init(void)
{
	TRISB=0;
	PORTB=0xff;
}

unsigned char i,j; 
unsigned int cnt,mst;
unsigned int gCnt,gCompCnt;


const unsigned char zhenz[]={0x01,0x02,0x04,0x08};
const unsigned char fanz[] ={0x08,0x04,0x02,0x01};

const unsigned char zhenz1[]={0x05,0x06,0x0a,0x09};

void delay(unsigned int Ms)
{
	
	unsigned char i;
	
	for( ; Ms != 0; Ms-- )
	{
		for(i = 1; i != 0; i-- );	
	}
}

void main(void)
{
	unsigned char i;
	init();
	RBPU=1;
	
	TMR0=200;//定时1mS初值装入TMR0
	T0CS=0;//选择TMR0工作
	PSA=0; 
	T0IF=0;//清TMR0溢出标志位
	PS2=1;//置TMR0的前置分频系数128
	PS1=0;
	PS0=1;
	T0IE=1;//允许TMR0产生中断
	GIE=1;//CPU开中断
	while(1)
	{	
		;
	}
}


void interrupt time0(void)
{
	T0IF=0;//清TMR0溢出标志位
	TMR0=240;//重新装入定时1mS的初值
	cnt++;
/*	if(mst==30)
	{
		mst=0;
		for(i=0;i<4;i++)
		{
			PORTB=zhenz1[i];
			delay(30);
		}
	}
	
	*/	
		switch(j)
		{
			case 0:PORTB=zhenz[0];
			break;
			case 1:PORTB=zhenz[1];
			break;
			case 2:PORTB=zhenz[2];
			break;
			case 3:PORTB=zhenz[3];
			break;	
		}
		j++;
		if(j==4)j=0;	
}