中科因仑“3+1”工程特种兵精英论坛
标题:
3路寻迹测试程序
[打印本页]
作者:
张衍波
时间:
2015-4-8 14:16
标题:
3路寻迹测试程序
#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
11=1
12=0
13=1;}
//fun2()
//{ P10=1
11=0
12=1
13=0;}
fun3()
{ P10=0
11=1
12=1
13=1;}
fun4()
{ P10=1
11=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();
}
}
欢迎光临 中科因仑“3+1”工程特种兵精英论坛 (http://bbs.enlern.com/)
Powered by Discuz! X3.4
11=112=013=1;}11=012=113=0;}11=112=113=1;}11=1;P12=1;P13=0;}