|
這下面是我編寫的一個(gè)紅外線避障智能小車的程序,下載附件是全部程序,謝謝。- #include<reg51.h>
- #define uint unsigned int
- #define uchar unsigned char
- sbit z=P0^0;//定義紅外避障檢測(cè)端口
- sbit q=P0^4;
- sbit y=P0^2;
- sbit mz=P1^5;//定義電機(jī)Mz電平輸出端口
- sbit IN1=P1^6;
- sbit IN2=P1^7;
- sbit my=P1^2;//定義電機(jī)My電平輸出端口
- sbit IN3=P1^3;
- sbit IN4=P1^4;
- void delayms(uint);//聲明延時(shí)函數(shù)
- main()//主函數(shù)
- {
- uint i=0;//初始值設(shè)定
- mz=1;
- my=1;
- while(1)//無限循環(huán)
- {
- if(z==0&&q==1&&y==1)//表示z方有障礙物 進(jìn)行y轉(zhuǎn)向
- {
- for(i=0;i<5;i++)
- {
- mz=1;
- IN1=1;
- IN2=0;
- my=0;
- delayms(100);//狀態(tài)保持100ms
- mz=0;
- my=0;
- delayms(2);//狀態(tài)保持2ms
- }
- }
- if(z==1&&q==0&&y==1)//表示前方有障礙物 進(jìn)行y轉(zhuǎn)向
- {
- for(i=0;i<5;i++)
- {
- mz=1;
- IN1=1;
- IN2=0;
- my=0;
- delayms(100);//狀態(tài)保持100ms
- mz=0;
- my=0;
- delayms(2);//狀態(tài)保持2ms
- }
- }
- if(z==1&&q==1&&y==0)//表示y方有障礙物 進(jìn)行z轉(zhuǎn)向
- {
- for(i=0;i<5;i++)
- {
- mz=0;
- my=1;
- IN3=1;
- IN4=0;
- delayms(100);//狀態(tài)保持100ms
- mz=0;
- my=0;
- delayms(2);//狀態(tài)保持2ms
- }
- }
- if(z==0&&q==0&&y==1)//表示z前方有障礙物 進(jìn)行y轉(zhuǎn)向
- {
- for(i=0;i<5;i++)
- {
- mz=1;
- IN1=1;
- IN2=0;
- my=0;
- delayms(100);//狀態(tài)保持100ms
- mz=0;
- my=0;
- delayms(2);//狀態(tài)保持2ms
- }
- }
- if(z==1&&q==0&&y==0)//表示y前方有障礙物 進(jìn)行z轉(zhuǎn)向
- {
- for(i=0;i<5;i++)
- {
- mz=0;
- my=1;
- IN3=1;
- IN4=0;
- delayms(100);//狀態(tài)保持100ms
- mz=0;
- my=0;
- delayms(2);//狀態(tài)保持2ms
- }
- }
復(fù)制代碼
|
-
-
紅外避障.doc
2018-8-3 10:06 上傳
點(diǎn)擊文件名下載附件
下載積分: 黑幣 -5
17.5 KB, 下載次數(shù): 54, 下載積分: 黑幣 -5
評(píng)分
-
查看全部評(píng)分
|