單片機尋黑線程序

ID:505762 · 發(fā)表于 2019-4-6 15:19

#include<reg52.h>
#define uint unsigned int
#define uchar unsigned char
sbit P10=P1^0; //  控制左電機前進
sbit P11=P1^1;//控制左電機后退
sbit P12=P1^2;//控制右電機
sbit P13=P1^3;//控制右電機
sbit P14=P1^4;//尋跡左
sbit P15=P1^5;//尋跡中
sbit P16=P1^6;//尋跡右
fun1()
{ P10=0;P11=1;P12=0;P13=1;}
//fun2()
//{ P10=1;P11=0;P12=1;P13=0;}
fun3()
{ P10=0;P11=1;P12=1;P13=1;}
fun4()
{ P10=1;P11=1;P12=1;P13=0;}
fun5()
{ P10=1;P11=1;P12=1;P13=1;}
void main()
{ while(1)
  { if((P14==0&&P15==1&&P16==0)||

(P14==0&&P15==0&&P16==0))
   fun1();
if(P14==1&&P15==0&&P16==0)
   fun4();
   if(P14==0&&P15==0&&P16==1)
   fun3();
if(P10==4&&P15==1&&P16==1)
   fun5();
  }
}

帳號		自動登錄	找回密碼
密碼			立即注冊