电梯实验

zwbrabbit

#include "reg52.h"
#include "MATH.h"
typedef unsigned int u16;       
typedef unsigned char u8;
typedef unsigned long u32;
typedef int uf16;       
typedef char uf8;
typedef long uf32;
sbit KEY1=P3^1;
sbit KEY2=P3^0;
sbit KEY3=P3^2;
sbit KEY4=P3^3;
sbit up=P2^0;
sbit down=P2^1;
sbit dy=P2^2;
#define KEY1_PRESS        1
#define KEY2_PRESS        2
#define KEY3_PRESS        3
#define KEY4_PRESS        4
#define KEY_UNPRESS        0
u8 current=1;
u8 call=0;
u8 key=0;
u8 Floordifference=0;       
void delay_10us(u32 ten_us)
{
        while(ten_us--);       
}
u8 key_scan(u8 mode)
{
        static u8 key=1;

        if(mode)key=1;
        if(key==1&&(KEY1==0||KEY2==0||KEY3==0||KEY4==0))
        {
                delay_10us(1000);
                key=0;
                if(KEY1==0)
                        return KEY1_PRESS;
                else if(KEY2==0)
                        return KEY2_PRESS;
                else if(KEY3==0)
                        return KEY3_PRESS;
                else if(KEY4==0)
                        return KEY4_PRESS;       
        }
        else if(KEY1==1&&KEY2==1&&KEY3==1&&KEY4==1)       
        {
                key=1;
                return KEY_UNPRESS;                               
        }
        return KEY_UNPRESS;               
}
void assignment()
{
         while(1)
        {       
                        key=key_scan(0);
                        if(key==KEY1_PRESS)
                        {
                                call=KEY1_PRESS;
                        }
                        else if(key==KEY2_PRESS)
                        {
                                call=KEY2_PRESS;
                        }
                        else if(key==KEY3_PRESS)
                        {
                                call=KEY3_PRESS;
                    }
                        else if(key==KEY4_PRESS)
                        {
                                call=KEY4_PRESS;
                        }
                        else if(KEY1==0||KEY2==0||KEY3==0||KEY4==0)
                        {
                        break;
                        }
        }
}
void lift()
{
       
        assignment();
        if(current<call)
        {
            Floordifference=call-current;
                current=call;
                up=0;
                delay_10us(Floordifference*50000);
                up=1;
        }
        else if(current>call)
        {
            Floordifference=current-call;
                current=call;
                down=0;
                delay_10us(Floordifference*50000);
                down=1;
        }               
//        else if(current==call)
//        {       
//                dy=0;
//                delay_10us(50000);
//                dy=1;
//        }               
}
void main()
{
while(1)
{
lift();
}
}

zwbrabbit

大佬们看看哪儿出了问题，反正就是编译也可以，物理运算应该也可以，就是单片机它老是卡bug，大家请多多指教。