步进电机控制器的设计

用单片机设计一个步进电机控制器。要求能对步进电机实现正、反转及速度控制，同时能对步进电机进行位置控制，即能控制步进电机从一个位置精确地运行到另一个位置。步进电机为四相反应式，软件生成脉冲序列，可设置参数和运行状态参数实时显示。技术要求  1. 转速：0—3000r/m，误差1‰；2. 角位移控制:2º—9999º；3. 方向：可逆；4. 可设置参数和运行状态参数实时显示。
下面是我写的一个简单的程序，但是我不知道该怎么修改才能满足题目的要求以及转速和角位移的显示程序，麻烦各位帮我看看，说说你们的想法，现在这谢了啊
#include        //51芯片管脚定义头文件
#include          //内部包含延时函数 _nop_();
#define uchar unsigned char
#define uint  unsigned int
uchar i,j,k;
uchar code zhengcode[8]={0x01,0x03,0x02,0x06,0x04,0x0c,0x08,0x09};  //四相八拍正转编码
uchar code fancode[8]={0x09,0x08,0x0c,0x04,0x06,0x02,0x03,0x01};  ////四相八拍反转编码
***it  K1   = P3^2;       //正转
***it  K2   = P3^3;       //反转
***it  K3   = P3^4;       //停止
void main()
{    TMOD=0X01;
     TH0=0xff;
         TL0=0xf6;        //定时0.01ms
         EA=1;
         ET0=1;
         TR0=1;
         i=0;
         j=0;
         k=100;                 
   if(K1==0)
   {  while(1)
        {           P1=zhengcode[i];
               if(K3==0)
                   {break;}
                           }
                                }
       
         else if(K2==0)
          {  while(1)
               
          {    P1=fancode[j];
             if(K3==0)
                   {break;}
                    }
                                }

   else P1=0xf0;
}
void  intt0() interrupt 1
{          k--;
     TH0=0xff;
         TL1=0xf6;
         if(k==0)
         {  k=100;
          i++;
          j++;}
        if(i==7)
        {i=0;}
        if(j==7)
        {j=0;}

}