#include<reg51.h>
#include"StepMot.h"

//定時器T1溢出做延時函數：T1_Delay()
void T1_Delay(uint temp)
{
	uint cnt;
	cnt = 65536 - 100*temp;	    //晶振：12MHz
	TMOD = TMOD | 0x20 ;        //T1 工作在方式1（16位計數器）
	TH1 = (uchar)(cnt >> 8);
	TL1 = cnt & 0xff;
	TR1 = 1;
	while(TF1 != 1);
	TF1 = 0;
	TR1 = 0;
	}

//以指定速度運行函數：MotRun()
void MotRun(uint speed)
{
	uint cnt;
	cnt = 12500/speed;
	AP = 1;
	AN = 0;
	BP = 0;
	BN = 0;
	T1_Delay(cnt);
	AP = 0;
	AN = 1;
	T1_Delay(cnt);
	AN = 0;
	BP = 1;
	T1_Delay(cnt);
	BP = 0;
	BN = 1;
	T1_Delay(cnt);
	BN = 0;	
	}


//停止電機函數：MotStop()
void MotStop(void)
{
	AP = 0;
	AN = 0;
	BP = 0;
	BN = 0;
	}