两个传感器循迹程序(详细注释)
单片机源程序如下:
- #include <reg52.h>
- #define uint unsigned int
- #define uchar unsigned char
- sbit left=P2^6;
- sbit right=P2^7;
- sbit s1=P2^2;
- sbit s2=P2^3;
- sbit s3=P2^0;
- sbit s4=P2^1;
- void run()
- {
- s1=1;s2=0;//前进
- s3=1;s4=0;
- }
- void right_run()//右转
- {
- s1=1;s2=0;//左轮前进右轮不动
- s3=0;s4=0;
- }
- void left_run()//左转
- {
- s1=0;s2=0;//左轮不动右轮前进
- s3=1;s4=0;
- }
- void stop_run()
- {
- s1=0;s2=0;s3=0;s4=0;
- }
- void main ()
- {
- while(1)
- {
- if(left==0&&right==0)
- {
- run();
- }
- if(left==1&&right==1)
- {
- stop_run();
- }
- if(left==1&&right==0)
- {
- left_run();
- }
- if(left==0&&right==1)
- {
- right_run();
- }
- }
- }
复制代码
所有资料51hei提供下载:
两个传感器.zip
(23.69 KB, 下载次数: 6)
|