15_3b.c

来自「51事例原代码 事例多多 应该对初学者很有用」· C语言 代码 · 共 25 行

unsigned char look (unsigned char s)	//五相十拍步进电机环形分配器  顺时针转
{
	if ((s==0x1F)||(s==0)) s=0x03;		//出现非法状态时，重新定相位
	if ((s&0x01)!=0) s=s+0x20;
	ACC=s>>1;
	if (P!=0) s=ACC&s; else s|=ACC;
	s&=0x1F;
return(s);
}

unsigned char back (unsigned char s)	//五相十拍步进电机环形分配器  逆时针转
{
	if ((s==0x1F)||(s==0)) s=0x03;		//出现非法状态时，重新定相位
	ACC=s<<1;
	if ((ACC&0x08)==0)
		{
		if ((ACC&0x20)!=0) ACC++;
		ACC&=0x1F;
		}
	if (P==0) s=ACC|s;
	else s=ACC&s;
	s&=0x1F;
return(s);
}