drivemoto.c

来自「基于凌阳61开发板」· C语言 代码 · 共 33 行

#include "SPCE061V004.h"

//uchar CONTROL[8]={ 0x30,0x10,0x90,0x80,0xC0,0x40,0x60,0x20};  //四相八拍步进电机换相的控制字。
//*********cw转动方向，spd 速度和num转动的步距*************
void DriveMoto(unsigned int cw,unsigned int spd,unsigned int num)
{
	unsigned int i;
	unsigned int j;
	unsigned int temp;
	if(cw) //正转
	{
		for(i=0,j=0;i<num;i++)		//P2 端口高四位控制步进电机换相
		{ 
			//temp=0x0;
			//P2|=CONTROL[j++];
			//Delay(spd); 			//高四位先清0,再赋值
			//j=j&0x07; 			//j=j%8 完成四相八拍CD-D-DA-A-AB-B-BC-C-CD
			//*P_Watchdog_Clear=C_WDTCLR;//clear watchdog清狗
		}
	}
	else //反转
	{
		for(i=0,j=7;i<num;i++)		//P2 端口高四位控制步进电机换相
			{ 					
				//P2&=0x0F;
				//P2|=CONTROL[j--];
				//Delay(spd); 		//高四位先清0,再赋值
				//j=j&0x07; 			//j=j%8
				//*P_Watchdog_Clear=C_WDTCLR;//clear watchdog清狗
			}
	}
}