15_3a.c

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

unsigned char look (unsigned char s)	//三相六拍步进电机环形分配器  顺时针转
{
	if ((s==0x07)||(s==0)) s=0x03;		//出现非法状态时，重新定相位
	s^=0x07;
	s<<=1;
	if ((s&0x08)!=0) s|=0x01;
	s&=0x07;
return(s);
}

unsigned char back (unsigned char s)	//三相六拍步进电机环形分配器  逆时针转
{
	if ((s==0x07)||(s==0)) s=0x03;		//出现非法状态时，重新定相位
	s&=0x07;
	s^=0x07;
	if ((s&0x01)!=0) s|=0x08;
	s>>=1;
return(s);
}