兩個傳感器循跡程序（詳細注釋）
單片機源程序如下:
- #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)
2018-2-24 09:01 上傳
點擊文件名下載附件
|
