单片机寻黑线程序 - - Powered by Discuz!

标题: 单片机寻黑线程序 [打印本页]

作者: stc89c52wzy 时间: 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();
  }
}

黑线.rar

3.4 KB, 下载次数: 4, 下载积分: 黑币 -5

循迹小车寻黑线程序

欢迎光临 (http://www.51hei.com/bbs/)