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

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 3639|回復(fù): 0
打印 上一主題 下一主題
收起左側(cè)

紅外避障舵機(jī)控制源程序

[復(fù)制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
ID:248426 發(fā)表于 2017-11-11 17:54 | 只看該作者 回帖獎勵 |倒序?yàn)g覽 |閱讀模式
  1. /*****************ZYDJ-CSB09A舵機(jī)控制*****************
  2. // 本程序主要將循跡程序、紅外避障程序、遙控器程序綜合在一起，通過主板按鍵切換
  3. ，藍(lán)色小主板是右邊按鍵S4切換，數(shù)碼管顯示1，就是循跡模式，按一下按鍵數(shù)碼管顯示2，
  4. 就是避障模式，按一下按鍵數(shù)碼管顯示3，就是紅外遙控程序，周而復(fù)始切換模式。

  6. ******************************************************************/

  8. //注意程序只做參考之用，要達(dá)到最理想的尋跡效果，還需要同學(xué)們細(xì)心調(diào)試。

  10. #include<AT89X52.H>    //包含51單片機(jī)頭文件，內(nèi)部有各種寄存器定義
  11. #include<ZY-4WD_PWM.H>    //包含HL-1藍(lán)牙智能小車驅(qū)動IO口定義等函數(shù)
  12. #include <intrins.h>
  13. #define uint    unsigned int                          //重定義無符號整數(shù)類型
  14. #define uchar   unsigned char                         //重定義無符號字符類型
  15. uchar code  LedShowData[]={0x03,0x9F,0x25,0x0D,0x99,  //定義數(shù)碼管顯示數(shù)據(jù)
  16.                             0x49,0x41,0x1F,0x01,0x19};//0,1,2,3,4,5,6,7,8,9
  17. uchar code  RecvData[]={0x19,0x46,0x15,0x44,0x43,0x40,0x0D,0x0E,0x00,0x0F};
  18. uchar IRCOM[7];
  19. unsigned char RunFlag=0;                              //定義運(yùn)行標(biāo)志位
  20. bit EnableLight=0;                                    //定義指示燈使能位
  21. sbit IRIN=P3^3;                                       //定義紅外接收端口
  22. /*********完成紅外接收端口的定義*************/
  23. #define ShowPort P2                                   //定義數(shù)碼管顯示端口
  24. sbit pwm=P1^6;//PWM信號輸出口  舵機(jī)信號輸出口
  25. unsigned char n,count,angle;//距離標(biāo)志位，0.5ms次數(shù)，角度標(biāo)識
  26. uchar i;
  27. extern void ControlCar(uchar CarType);                //聲明小車控制子程序
  28. unsigned char temp = 1;
  29. void delay_nus(unsigned int i)  //延時:i>=12 ,i的最小延時單12 us
  30. {
  31.   i=i/10;
  32.   while(--i);
  33. }   
  34. void delay_nms(unsigned int n)  //延時n ms
  35. {
  36.   n=n+1;
  37.   while(--n)  
  38.   delay_nus(900);         //延時 1ms,同時進(jìn)行補(bǔ)償
  39.   
  40. }
  41. void delayms(unsigned char x)                         //0.14mS延時程序
  42. {
  43.   unsigned char i;                                    //定義臨時變量
  44.   while(x--)                                          //延時時間循環(huán)
  45.   {
  46.     for (i = 0; i<13; i++) {}                         //14mS延時
  47.   }
  48. }
  49. void Delay5()                                          //定義延時子程序
  50. { uint DelayTime=30000;                               //定義延時時間變量
  51.   while(DelayTime--);                                 //開始進(jìn)行延時循環(huán)
  52.   return;                                             //子程序返回
  53. }
  54. /*------------------------------------------------
  55.                     定時器01初始化
  56. //定時器1工作方式1 (舵機(jī) )，定時器0 電機(jī)PWM調(diào)速控制信號
  57. ------------------------------------------------*/
  58. void ControlCar(unsigned char ConType)    //定義電機(jī)控制子程序
  59. {

  61. switch(ConType)                          //判斷用戶設(shè)定電機(jī)形式
  62. {
  63.   case 1:  //前進(jìn)                         //判斷用戶是否選擇形式1
  64.   {
  65.     run();   //調(diào)用前進(jìn)函數(shù)
  66. angle=12 ;
  67. ShowPort=LedShowData[1];
  68.     break;
  69.   }
  70.   case 2: //后退                              //判斷用戶是否選擇形式2
  71.   {
  72.     Rearrun ();  //后退  1600MS
  73. angle=12;
  74. ShowPort=LedShowData[2];                             //M2電機(jī)反轉(zhuǎn)
  75.     break;
  76.   }
  77.   case 3: //左轉(zhuǎn)                              //判斷用戶是否選擇形式3
  78.   {
  79.     leftrun();    //調(diào)用小車左轉(zhuǎn)  函數(shù)
  80.     angle=14;  
  81. ShowPort=LedShowData[3];                             //M2電機(jī)正轉(zhuǎn)
  82. break;
  83.   }
  84.   case 4: //右轉(zhuǎn)                              //判斷用戶是否選擇形式4
  85.   {
  86.                                   //M1電機(jī)正轉(zhuǎn)
  87.     rightrun();     //調(diào)用小車右轉(zhuǎn) 函數(shù)
  88.     angle=10;                                      //M2電機(jī)反轉(zhuǎn)
  89. ShowPort=LedShowData[4];
  90. break;
  91.   }
  92.   case 5: //停止                          //判斷用戶是否選擇形式8
  93.   {
  94.     Stoptrun();
  95. angle=12;
  96. ShowPort=LedShowData[0];
  97. break;                                //退出當(dāng)前選擇
  98.   }
  99. }
  100. }
  101. void ControlCar_yaokong(unsigned char ConType)    //定義電機(jī)控制子程序 (紅外遙控單獨(dú)設(shè)置一個 switch  case  語句  )
  102. {

  104. switch(ConType)                          //判斷用戶設(shè)定電機(jī)形式
  105. {
  106.   case 1:  //前進(jìn)                         //判斷用戶是否選擇形式1
  107.   {
  108.     run();   //調(diào)用前進(jìn)函數(shù)
  109. angle=12 ;
  110. ShowPort=LedShowData[1];
  111.     break;
  112.   }
  113.   case 2: //后退                              //判斷用戶是否選擇形式2
  114.   {
  115.     Rearrun ();  //后退  1600MS
  116. angle=12;
  117. ShowPort=LedShowData[2];                             //M2電機(jī)反轉(zhuǎn)
  118.     break;
  119.   }
  120.   case 3: //左轉(zhuǎn)                              //判斷用戶是否選擇形式3
  121.   {
  122.     leftrun();    //調(diào)用小車左轉(zhuǎn)  函數(shù)
  123.     angle=14;  
  124. ShowPort=LedShowData[3];                             //M2電機(jī)正轉(zhuǎn)
  125. break;
  126.   }
  127.   case 4: //右轉(zhuǎn)                              //判斷用戶是否選擇形式4
  128.   {
  129.                                   //M1電機(jī)正轉(zhuǎn)
  130.     rightrun();     //調(diào)用小車右轉(zhuǎn) 函數(shù)
  131.     angle=10;                                      //M2電機(jī)反轉(zhuǎn)
  132. ShowPort=LedShowData[4];
  133. break;
  134.   }
  135.   case 5: //停止                          //判斷用戶是否選擇形式8
  136.   {
  137.     Stoptrun();
  138. angle=12;
  139. ShowPort=LedShowData[0];
  140. break;                                //退出當(dāng)前選擇
  141.   }
  142. }
  143. }
  144. void Robot_Avoidance()                   //機(jī)器人避障子程序
  145. {
  146.    //有信號為0  沒有信號為1
  147.               if(LeftIRBZ ==1&&RightIRBZ ==1)  // 前面 沒有障礙物  前速前進(jìn)
  148.      {
  149.      run();   //調(diào)用前進(jìn)函數(shù)
  150.      angle=12 ;
  151.      }
  152.       if(RightIRBZ ==0&&LeftIRBZ ==0)  //左右兩邊同時檢測到障礙物
  153.       {   
  154.          
  155.      
  156.        Rearrun ();  //后退  1600MS
  157.        angle=12;
  158.             delay_nms(500);

  160.       leftrun();    //調(diào)用小車左轉(zhuǎn)  函數(shù)
  161.                      angle=14;
  162.       delay_nms(1000);
  163.       }
  164.             
  165.       if(LeftIRBZ ==0&&RightIRBZ ==1)     //左邊檢測到障礙物
  166.       {
  167.       
  168.       rightrun();     //調(diào)用小車右轉(zhuǎn) 函數(shù)
  169.       angle=10;
  170.         }
  171.       
  172.      if(RightIRBZ ==0&&LeftIRBZ ==1)  //右邊檢測到障礙物
  173.       {   
  174.          
  175.        leftrun();    //調(diào)用小車左轉(zhuǎn)  函數(shù)
  176.                       angle=14;
  177.       }
  178. }
  179. //機(jī)器人循跡子程序
  180. void Robot_Traction()                     //機(jī)器人循跡子程序
  181. {
  182.      if(Left_1_led==0&&Right_1_led==0)
  183.      {
  184.      run();   //調(diào)用前進(jìn)函數(shù)
  185.      angle=12 ;
  186.      }
  187.   else
  188. {     
  189.      if(Left_1_led==0&&Right_1_led==1)     //左邊檢測到黑線
  190.     {
  191.       
  192.     rightrun();     //調(diào)用小車右轉(zhuǎn) 函數(shù)
  193.     angle=10;
  194.      }
  195.       
  196.    if(Right_1_led==0&&Left_1_led==1)  //右邊檢測到黑線
  197.    {   
  198.          
  199.                leftrun();    //調(diào)用小車左轉(zhuǎn)  函數(shù)
  200.                angle=14;
  201.    }
  202. }
  203. }
  204. void Time1_Int() interrupt 3//舵機(jī)
  205. {
  206. TH1=0xff;
  207. TL1=0xa3;
  208. if(count<angle)//判斷0.5ms次數(shù)是否小于角度標(biāo)識
  209.     pwm=1;//確實(shí)小于，pwm輸出高電平
  210.     else
  211.     pwm=0;//大于則輸出低電平
  212. count=(count+1);//0.5ms次數(shù)加1
  213. count=count%40;//次數(shù)始終保持為40即保持周期為20ms
  214. }

  216. //主函數(shù)
  217. void main(void)
  218. {
  219. angle=12;//舵機(jī)居中
  220.     count=0;
  221.     P0=0XF0;   //關(guān)電機(jī)
  222.     //本實(shí)驗(yàn)學(xué)習(xí)的知識蜂鳴器，注意要在HJ-4WD頭文件里定義IO口
  223. BUZZ=0; //50次檢測K4確認(rèn)是按下之后，蜂鳴器發(fā)出“滴”聲響，然后啟動小車。
  224. delay(50);
  225.     BUZZ=1;//響50ms后關(guān)閉蜂鳴器
  226. TMOD=0X11;
  227.     TH0= 0XFc;    //1ms定時
  228.     TL0= 0X18;
  229.     TR0= 1;
  230.     ET0= 1;
  231. EA = 1;      //開總中斷
  232. TH1=0xff;
  233. TL1=0xa3;
  234. ET1=1;
  235. TR1= 1;
  236.    
  237. IT1=1;                                               //設(shè)定外部中斷1為低邊緣觸發(fā)類型
  238.     Stoptrun();
  239. while(1) //無限循環(huán)
  240. {
  241.    if(P3_2 == 0)
  242.    {
  243.     delay_nms(10);
  244.     if(P3_2 == 0)
  245.     {
  246.        temp++;
  247.     while(!P3_2);
  248.     }
  249.    }
  250.    if(temp > 3)
  251.    {
  252.    temp = 1;
  253.    }
  254.    switch(temp)
  255.    {
  256.      case 1: ShowPort = LedShowData[1];Robot_Traction();EX1 = 0;break;
  257.   case 2: ShowPort = LedShowData[2];Robot_Avoidance();EX1 = 0;break;
  258.   case 3: ShowPort = LedShowData[3];EX1 = 1;break;
  259.    }
  260.   
  261.   }
  262. }
  263. //----------紅外遙控-------------------------------------------------------------
  264. void IR_IN() interrupt 2 using 0                      //定義INT2外部中斷函數(shù)
  265. {
  266.   unsigned char j,k,N=0;                              //定義臨時接收變量
  267.    
  268.   EX1 = 0;                                            //關(guān)閉外部中斷,防止再有信號到達(dá)   
  269.   delayms(15);                                        //延時時間，進(jìn)行紅外消抖
  270.   if (IRIN==1)                                        //判斷紅外信號是否消失
  271.   {  
  272.      EX1 =1;                                          //外部中斷開
  273.   return;                                          //返回
  274.   }
  275.                            
  276.   while (!IRIN)                                       //等IR變?yōu)楦唠娖剑^9ms的前導(dǎo)低電平信號。
  277.   {
  278.       delayms(1);                                     //延時等待
  279.   }
  280.   for (j=0;j<4;j++)                                   //采集紅外遙控器數(shù)據(jù)
  281.   {
  282.     for (k=0;k<8;k++)                                 //分次采集8位數(shù)據(jù)
  283.     {
  284.        while (IRIN)                                   //等 IR 變?yōu)榈碗娖剑^4.5ms的前導(dǎo)高電平信號。
  285.        {
  286.          delayms(1);                                  //延時等待
  287.        }
  288.       
  289.        while (!IRIN)                                  //等 IR 變?yōu)楦唠娖?br />
  290.        {
  291.          delayms(1);                                  //延時等待
  292.        }
  293.    
  294.        while (IRIN)                                   //計(jì)算IR高電平時長
  295.        {
  296.          delayms(1);                                  //延時等待
  297.          N++;                                         //計(jì)數(shù)器加加
  298.          if (N>=30)                                   //判斷計(jì)數(shù)器累加值
  299.       {
  300.            EX1=1;                                     //打開外部中斷功能
  301.         return;                                    //返回
  302.          }                  
  303.        }
  304.                                        
  305.       IRCOM[j]=IRCOM[j] >> 1;                         //進(jìn)行數(shù)據(jù)位移操作并自動補(bǔ)零
  306.      
  307.       if (N>=8)                                       //判斷數(shù)據(jù)長度
  308.       {
  309.          IRCOM[j] = IRCOM[j] | 0x80;                  //數(shù)據(jù)最高位補(bǔ)1
  310.       }
  311.       N=0;                                            //清零位數(shù)計(jì)錄器
  312.     }
  313.   }
  314.    
  315.   if (IRCOM[2]!=~IRCOM[3])                            //判斷地址碼是否相同
  316.   {
  317.      EX1=1;                                           //打開外部中斷
  318.      return;                                          //返回
  319.   }
  320.   for(j=0;j<10;j++)                                   //循環(huán)進(jìn)行鍵碼解析
  321.    {
  322.       if(IRCOM[2]==RecvData[j])                       //進(jìn)行鍵位對應(yīng)
  323.       {
  324.        // ControlCar(j);
  325.   ControlCar_yaokong(j);                               //數(shù)碼管顯示相應(yīng)數(shù)碼
  326.       }
  327.    }
  328.    EX1 = 1;                                           //外部中斷開
  329. }
復(fù)制代碼
分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏 分享淘帖 頂頂 踩踩
回復(fù)

使用道具 舉報(bào)

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

本版積分規(guī)則

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

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

快速回復(fù) 返回頂部 返回列表
主站蜘蛛池模板： 涩涩鲁亚洲精品一区二区 | 天天综合天天 | japanhd成人| 99精品视频在线观看免费播放 | 草比av| 精品久久久久久一区二区 | 妖精视频一区二区三区 | 91亚洲精| 极品一区 | 婷婷一级片 | 亚洲福利一区 | 日韩一区二区三区视频 | 国产资源在线观看 | 国产精品综合 | 国产欧美日韩视频 | 亚洲在线一区 | 国产精品国产三级国产播12软件 | 国产免费观看久久黄av片涩av | 99reav| 在线观看成人小视频 | jlzzjlzz欧美大全 | 美女在线视频一区二区三区 | 不卡一区二区三区四区 | 亚洲在线视频 | www狠狠干 | 久久日韩精品 | 欧美色综合| 欧美视频一区二区三区 | 国产极品粉嫩美女呻吟在线看人 | 国产高清一二三区 | av网站在线看 | 亚洲免费影院 | 99re6在线视频精品免费 | 国产精品乱码一区二区三区 | 日韩欧美在线不卡 | 一级一级一级毛片 | 亚洲成人免费视频 | 在线观看成年人视频 | 欧美性猛交一区二区三区精品 | 中文字字幕一区二区三区四区五区 | 视频二区在线观看 |