找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 1794|回復(fù): 0
收起左側(cè)

51單片機(jī)小車避障程序與電路原理圖

[復(fù)制鏈接]
ID:1073111 發(fā)表于 2023-4-26 11:42 | 顯示全部樓層 |閱讀模式
電路原理圖如下：
51hei.png

單片機(jī)源程序如下:
  1. /**********  循跡程序  ************************/

  3. //    接口連接：

  5. //    P0.0和P0.1-----右電機(jī)
  6. //    P0.2和P0.3-----左電機(jī)

  8. //    P1.0-----------右光電管
  9. //    P1.1-----------前光電管
  10. //    P1.2-----------左光電管

  12. /*****************************************************/

  14. #include<reg52.h>//包含必要頭文件

  16. sbit you1=P0^0;//定義單片機(jī)控制右邊電機(jī)的引腳
  17. sbit you2=P0^1;//定義單片機(jī)控制右邊電機(jī)的引腳
  18. sbit zuo1=P0^2;//定義單片機(jī)控制左邊電機(jī)的引腳
  19. sbit zuo2=P0^3;//定義單片機(jī)控制左邊電機(jī)的引腳

  21. sbit q=P1^1;//定義單片機(jī)連接循跡板前邊光電管的引腳
  22. sbit y=P1^0;//定義單片機(jī)連接循跡板右邊光電管的引腳
  23. sbit z=P1^2;//定義單片機(jī)連接循跡板左邊光電管的引腳


  26. void delay(int z)//pwm中使用的延時(shí)函數(shù)
  27. {
  28.         int i,j;
  29.         for(i=2;i>0;i--)
  30.         for(j=z;j>0;j--);        
  31. }
  32. void qian()//左右輪協(xié)同前進(jìn)子函數(shù)
  33. {
  34.         you1=0;
  35.         you2=1;
  36.         zuo1=0;
  37.         zuo2=1;
  38.         delay(8);//pwm調(diào)速 此為pwm有效值，前進(jìn)時(shí)速度為全速的90%
  39.         you1=1;
  40.         you2=1;
  41.         zuo1=1;
  42.         zuo2=1;
  43.         delay(10-8);         
  44. }
  45. void you()//左右輪協(xié)同  右轉(zhuǎn)子函數(shù)
  46. {
  47.         you1=0;
  48.         you2=1;
  49.         zuo1=1;
  50.         zuo2=0;
  51.         delay(7);//pwm調(diào)速 此為pwm有效值，前進(jìn)時(shí)速度為全速的80%
  52.         you1=1;
  53.         you2=1;
  54.         zuo1=1;
  55.         zuo2=1;
  56.         delay(10-7);
  57. }
  58. void zuo()//左右輪協(xié)同  左轉(zhuǎn)子函數(shù)
  59. {
  60.         you1=1;
  61.         you2=0;
  62.         zuo1=0;
  63.         zuo2=1;
  64.         delay(7);//pwm調(diào)速 此為pwm有效值，前進(jìn)時(shí)速度為全速的80%
  65.         you1=1;
  66.         you2=1;
  67.         zuo1=1;
  68.         zuo2=1;
  69.         delay(10-7);
  70. }
  71. void ting()//左右輪都停止轉(zhuǎn)動(dòng)
  72. {
  73.         you1=1;
  74.         you2=1;
  75.         zuo1=1;
  76.         zuo2=1;
  77.         delay(50000);
  78. }

  80. //下面是后退函數(shù)，這里沒有用到，注釋掉了

  82. /*
  83. void hou()//左右輪協(xié)同前進(jìn)子函數(shù)
  84. {
  85.         you1=1;
  86.         you2=0;
  87.         zuo1=1;
  88.         zuo2=0;
  89.         
  90. }
  91. */


  94. void main()//主函數(shù)
  95. {
  96.            z=1;
  97.            q=1;
  98.            y=1;

  100.                 while(1)//單片機(jī)不間斷監(jiān)測 （是個(gè)死循環(huán)）
  101.                 {           
  102.                                                                   
  103.                                 qian();//調(diào)用前進(jìn)子函數(shù)，使小車光電管不滿足以下幾個(gè)條件時(shí)都處于前進(jìn)狀態(tài)
  104.                                 while((z==0)&&(y==1))//判斷當(dāng)左邊光電管遇到黑線時(shí)
  105.                                 {                                                        
  106.                                         zuo();//調(diào)用左轉(zhuǎn)子函數(shù)
  107.                                 }
  108.                                 while((z==1)&&(y==0))//判斷當(dāng)右邊光電管遇到黑線時(shí)
  109.                                 {        
  110.                                         you();//調(diào)用右轉(zhuǎn)子函數(shù)
  111.                                 }
  112.                                 while((z==0)&&(q==0)&&(y==0))//判斷當(dāng)左、前、右光電管均遇到黑線時(shí)
  113.                                 {
  114.                                          qian();                     //即遇到十字路口時(shí) 繼續(xù)前進(jìn)                                                        
  115.                                 }
  116.                                 while((z==0)&&(q==1)&&(y==0))//判斷當(dāng)左、右光電管均遇到黑線，前光電管時(shí)
  117.                                 {
  118.                                 
  119.                                         ting();                          //即遇到T字路口時(shí) 停止
  120.                                        
  121.                                 }
  122.                                                 
  123.                  }
  124. }
復(fù)制代碼
回復(fù)

使用道具 舉報(bào)

您需要登錄后才可以回帖 登錄 | 立即注冊

本版積分規(guī)則

小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術(shù)交流QQ群281945664

Powered by 單片機(jī)教程網(wǎng)

快速回復(fù) 返回頂部 返回列表