久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

標題: 51單片機小車避障程序與電路原理圖 [打印本頁]
作者: njz123    時間: 2023-4-26 11:42
標題: 51單片機小車避障程序與電路原理圖
電路原理圖如下：


單片機源程序如下:
  1. /**********  循跡程序  ************************/

  3. //    接口連接：

  5. //    P0.0和P0.1-----右電機
  6. //    P0.2和P0.3-----左電機

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

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

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

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

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


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

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

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


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

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




歡迎光臨 (http://www.zg4o1577.cn/bbs/) Powered by Discuz! X3.1
主站蜘蛛池模板： 狠狠色网 | 日韩一区二区三区在线观看 | 特级a欧美做爰片毛片 | 国产激情一区二区三区 | 日韩久久网 | 精品国产91久久久久久 | av手机在线播放 | 欧美一页 | 一区二区三区回区在观看免费视频 | 久久av影院| 久久福利网站 | 99热这里有精品 | 一区二区三区精品在线 | 中文字幕在线播放不卡 | 日韩高清中文字幕 | 国产福利小视频 | 91精品国产色综合久久 | 特黄毛片 | 日本中文字幕日韩精品免费 | 国产伦精品一区二区三区四区视频 | 亚洲欧美在线一区 | 日韩欧美国产精品一区二区 | 亚洲自拍偷拍免费视频 | 亚洲国产aⅴ成人精品无吗 综合国产在线 | 在线观看av中文字幕 | 影音先锋中文在线 | 欧美日韩高清一区 | 欧美亚洲视频在线观看 | 91精品一区二区 | 欧美一二三 | 国产亚洲欧美另类一区二区三区 | av大片在线 | 欧美www在线 | 欧美激情一区二区三级高清视频 | 久久毛片网站 | 黄色电影在线免费观看 | 黄色片网站国产 | 99欧美精品| 精品久久久久香蕉网 | 日日操夜夜操天天操 | 91麻豆精品国产91久久久更新资源速度超快 |