zidong.c

stc 单片机控制电机运动 需加驱动能力控制继电器等

#include<reg51stc.h>
//--------------------------------------------------
//---------端口定义---------------------------------

sbit m1_1=P0^2;                    // 行走电机in1
sbit m1_2=P0^5;                    // 行走电机e  0 有效
sbit m2_1=P0^1;                    // 提升电机in1
sbit m2_2=P0^4;                    // 提升电机e  0 有效
sbit c   =P0^7;                       // 检测传感器口
//-------------------------------------------------
//------------变量定义-----------------------------
unsigned int t;                    //状态标志变量
//---------------------------------------------------
//----------函数定义--------------------------------
void m1_run()
     {
      m1_1=1;
      m1_2=0;
     }


void m1_stop()
     {
      m1_1=0;
      m1_2=0;
     }

void m2_rise()
     {
      m2_1=1;
      m2_2=0;
     }

void m2_drop()
     {
      m2_1=0;
      m2_2=1;
     }

void m2_stop()
     {
      m2_1=0;
      m2_2=0;
     }

void delay()
     {
     long double i,j;
     for(i=0;i<1000;i++)
	 for(i=0;j<10000;j++);
     }

void delay1()
     {
     long double j;
     for(j=0;j<500;j++);
     }
void check()
     {
      if(c==0)
        {delay1();
         if(c==0)t=0;
         }
       else t=1;
     }

//----------------------------------------------------
//-----------主函数-----------------------------------
void main()
{
        m1_run();
        delay();
//      do{;}while();              // 等待至停止时刻
        m1_stop();                 // 停止前进
        m2_rise();                 // 上升
        do{                        //
           check();                //
           } while(t);             // 等待至停止信号出现
        m2_stop();                 // 停止上升
        delay();                   // 延时
        m2_drop();                 // 下降
        do{                        //
           check();                //
           } while(t);             // 等待至下降信号出现
        m2_stop();                 // 停止下降


}
//-----------主函数结束--------------------------------