C51控制直流电机转速

要求如下：
直流电机转速控制，要求由开关K0-K3控制4种转速，停止键是K4。
我想用电机停、转的延时不同来控制转速，用P1口的引脚实现。不过如果有其他方法简单的话给我发过来也可以。麻烦各位精英啦！

#include<reg51.h>  //
#include<absacc.h>  //
//#include<intrins.h>
sbit K0=P1^1;//可位寻址的变量，连接开关
sbit K1=P1^2;
sbit K2=P1^3;
sbit K3=P1^6;
sbit K4=P1^5;
#define D0832 XBYTE[0x8000] //8000H接收不同的数字信号
void check1()
{
 if(K0==1&&K1==0&&K2==0&&K3==0&&K4==0)
 {
  D0832=0x20;
 }
 else if(K0==0&&K1==1&&K2==0&&K3==0&&K4==0)
 {
  D0832=0x40;
 }
 else if(K0==0&&K1==0&&K2==1&&K3==0&&K4==0)
 {
  D0832=0x60;
 }
 else if(K0==0&&K1==0&&K2==0&&K3==1&&K4==0)
 {
  D0832=0x80;
 }
 else
 {
  D0832=0x00;
 }
}
void main()
{
  for( ; ;)
  {
    check1();
  } 
}