|
兩個(gè)傳感器循跡程序(詳細(xì)注釋?zhuān)?br />
單片機(jī)源程序如下:
- #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;//前進(jìn)
- s3=1;s4=0;
- }
- void right_run()//右轉(zhuǎn)
- {
- s1=1;s2=0;//左輪前進(jìn)右輪不動(dòng)
- s3=0;s4=0;
- }
- void left_run()//左轉(zhuǎn)
- {
- s1=0;s2=0;//左輪不動(dòng)右輪前進(jìn)
- 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();
- }
- }
- }
復(fù)制代碼
所有資料51hei提供下載:
兩個(gè)傳感器.zip
(23.69 KB, 下載次數(shù): 6)
2018-2-24 09:01 上傳
點(diǎn)擊文件名下載附件
下載積分: 黑幣 -5
|
|