以下能驱动两相四线步进电机正转反转

按键1正转 键2反转   功能正常
我想让按键按下后能转且持续2秒转动后停止。最好两键能互锁。

小白能力有限 望各位高手不吝赐教。 特此感谢了

#include <reg52.h>
sbit EN=P1^6;                       //使能   
sbit A1=P1^7;
sbit B1=P1^5;
sbit Key1=P3^7;                     //按键！
sbit Key2=P3^5;                     //按键！

void D_MS(void){
        unsigned int i=80;         //速度
        for(;i>0;i--)           
                ;               
}

void RRM(void){                                   //正转
        EN=1;  
        A1=1;
        D_MS();
        B1=1;
        D_MS();
        A1=0;
        D_MS();
        B1=0;
        D_MS();       
        EN=0;
}

void LLM(void){                                  //反转
        EN=1;
        B1=0;
        D_MS();
        A1=0;
        D_MS();
        B1=1;
        D_MS();
        A1=1;
        D_MS();
        EN=0;

}

void main(void){
        A1=0;
        B1=0;
        EN=0;
        while(1){
               
                if(Key1==0){
                        D_MS();
                        while(Key1==0){
                                RRM();
                        }
                }
                if(Key2==0){
                        D_MS();
                        while(Key2==0){
                                LLM();
                        }
                }
        }
}