hard.c

来自「嵌入式linux学习之uclinux步进电机驱动实例（测试平台S3C44B0X,」· C语言 代码 · 共 33 行

//control the hardware
usigned short x_steptable[8] = 
	{0x0001, 0x0005, 0x0004, 0x0006, 0x0002, 0x000A, 0x0008, 0x0009};
usigned short y_steptable[8] = 
	{0x0010, 0x0050, 0x0040, 0x0060, 0x0020, 0x00A0, 0x0080, 0x0090};
usigned short z_steptable[8] = 
	{0x0100, 0x0500, 0x0400, 0x0600, 0x0200, 0x0A00, 0x0800, 0x0900};
usigned short flipbits = 0x0B00;
usigned short irq_enable_bit = 0x1000;

void move_one_step()
{
	if(xdest > xpos){
		xpos++;
	}else if(xdest < xpos){
		xpos--;
	}

	if(ydest > ypos){
		ypos++;
	}else if(ydest < ypos){
		ypos--;
	}

	if(zdest > zpos){
		zpos++;
	}else if(zdest < zpos){
		zpos--;
	}



}