標(biāo)題: 51單片機(jī)智能車超聲波舵機(jī)避障程序分享 [打印本頁(yè)]
作者: 賊六的噠噠噠    時(shí)間: 2021-4-25 16:40
標(biāo)題: 51單片機(jī)智能車超聲波舵機(jī)避障程序分享
附加程序
  1. #include <reg52.h>//51頭文件
  2. #include <QX_A11.h>//QX_A11智能小車配置文件
  3. #include <intrins.h>
  4. bit Timer1Overflow;        //計(jì)數(shù)器1溢出標(biāo)志位
  5. unsigned char disbuff[4]={0,0,0,0};//用于分別存放距離的值米，厘米，毫米
  6. unsigned int LeftDistance = 0, RightDistance = 0, FrontDistance = 0; //云臺(tái)測(cè)距距離緩存
  7. unsigned int DistBuf[5] = {0};//distance data buffer
  8. unsigned char        pwm_val_left,pwm_val_right;        //中間變量，用戶請(qǐng)勿修改。
  9. unsigned char         pwm_left,pwm_right;                        //定義PWM輸出高電平的時(shí)間的變量。用戶操作PWM的變量。
  10. #define                PWM_DUTY                200                        //（用于舵機(jī)時(shí)不可修改）定義PWM的周期，數(shù)值為定時(shí)器0溢出周期，假如定時(shí)器溢出時(shí)間為100us，則PWM周期為20ms。
  11. #define                PWM_HIGH_MIN        70                        //限制PWM輸出的最小占空比。用戶請(qǐng)勿修改。
  12. #define                PWM_HIGH_MAX        PWM_DUTY        //限制PWM輸出的最大占空比。用戶請(qǐng)勿修改。

  14. void Timer0_Init(void); //定時(shí)器0初始化
  15. void Timer1_Init(void);//定時(shí)器1初始化
  16. void LoadPWM(void);//裝入PWM輸出值
  17. void Delay_Ms(unsigned int ms);//毫秒級(jí)延時(shí)函數(shù)
  18. void forward(unsigned char LeftSpeed,unsigned char RightSpeed);//QX_A11智能小車前進(jìn)
  19. void left_run(unsigned char LeftSpeed,unsigned char RightSpeed);//QX_A11智能小車左轉(zhuǎn)  
  20. void right_run(unsigned char LeftSpeed,unsigned char RightSpeed);//QX_A11智能小車右轉(zhuǎn)
  21. //void back_run(unsigned char LeftSpeed,unsigned char RightSpeed);//QX_A11智能小車后退
  22. void stop(void);//QX_A11智能小車停車
  23. void Delay18450us(void);        //@11.0592MHz
  24. void Delay1550us(void);                //@11.0592MHz
  25. void Delay19400us(void);        //@11.0592MHz
  26. void Delay600us(void);                //@11.0592MHz
  27. void Delay17500us(void);        //@11.0592MHz
  28. void Delay2500us(void);                //@11.0592MHz
  29. void QXMBOT_bubble(unsigned int *a,unsigned char n);//冒泡排序
  30. void QXMBOT_ServoFront(void);//舵機(jī)向前
  31. void QXMBOT_ServoLeft(void);//舵機(jī)左轉(zhuǎn)
  32. void QXMBOT_ServoRight(void);//舵機(jī)右轉(zhuǎn)
  33. void  QXMBOT_PTZ_Avoid(unsigned int val);//舵機(jī)云臺(tái)避障
  34. unsigned int QXMBOT_GetDistance(void);//獲取超聲波距離
  35. void QXMBOT_TrigUltrasonic(void);// 觸發(fā)超聲波
  36. unsigned int QXMBOT_RefreshDistance(void);//超聲波測(cè)距

  38. /*主函數(shù)*/     
  39. void main(void)
  40. {
  41.         Timer0_Init();//定時(shí)0初始化
  42.         Timer1_Init();//定時(shí)0初始化
  43.         EA_on;        //開(kāi)中斷
  44.         QXMBOT_ServoFront();//舵機(jī)向前
  45.         Delay_Ms(1000);
  46.         forward(120,120);//前進(jìn)
  47.         while(1)
  48.         {
  49.                 QXMBOT_PTZ_Avoid(300);//舵機(jī)云臺(tái)避障，LCD1602顯示距離,形參設(shè)置觸發(fā)距離，單位：毫米
  50.         }        
  51. }


  54. /*********************************************
  55. QX_A11智能小車前進(jìn)
  56. 入口參數(shù)：LeftSpeed，RightSpeed
  57. 出口參數(shù): 無(wú)
  58. 說(shuō)明：LeftSpeed，RightSpeed分別設(shè)置左右車輪轉(zhuǎn)速
  59. **********************************************/
  60. void forward(unsigned char LeftSpeed,unsigned char RightSpeed)
  61. {
  62.         pwm_left = LeftSpeed,pwm_right =  RightSpeed;//設(shè)置速度
  63.         left_motor_go; //左電機(jī)前進(jìn)
  64.         right_motor_go; //右電機(jī)前進(jìn)
  65. }
  66. /*小車左轉(zhuǎn)*/
  67. /*********************************************
  68. QX_A11智能小車左轉(zhuǎn)
  69. 入口參數(shù)：LeftSpeed，RightSpeed
  70. 出口參數(shù): 無(wú)
  71. 說(shuō)明：LeftSpeed，RightSpeed分別設(shè)置左右車輪轉(zhuǎn)速
  72. **********************************************/
  73. void left_run(unsigned char LeftSpeed,unsigned char RightSpeed)
  74. {
  75.         pwm_left = LeftSpeed,pwm_right =  RightSpeed;//設(shè)置速度
  76.         left_motor_back; //左電機(jī)后退
  77.         right_motor_go; //右電機(jī)前進(jìn)        
  78. }

  80. /*********************************************
  81. QX_A11智能小車右轉(zhuǎn)
  82. 入口參數(shù)：LeftSpeed，RightSpeed
  83. 出口參數(shù): 無(wú)
  84. 說(shuō)明：LeftSpeed，RightSpeed分別設(shè)置左右車輪轉(zhuǎn)速
  85. **********************************************/
  86. void right_run(unsigned char LeftSpeed,unsigned char RightSpeed)
  87. {
  88.         pwm_left = LeftSpeed,pwm_right =  RightSpeed;//設(shè)置速度
  89.         right_motor_back;//右電機(jī)后退
  90.         left_motor_go;    //左電機(jī)前進(jìn)
  91. }
  92. /*********************************************
  93. QX_A11智能小車后退
  94. 入口參數(shù)：LeftSpeed，RightSpeed
  95. 出口參數(shù): 無(wú)
  96. 說(shuō)明：LeftSpeed，RightSpeed分別設(shè)置左右車輪轉(zhuǎn)速
  97. **********************************************/
  98. //void back_run(unsigned char LeftSpeed,unsigned char RightSpeed)
  99. //{
  100. //        pwm_left = LeftSpeed,pwm_right =  RightSpeed;//設(shè)置速度
  101. //        right_motor_back;//右電機(jī)后退
  102. //        left_motor_back; //左電機(jī)后退
  103. //}
  104. /*********************************************
  105. QX_A11智能小車停車
  106. 入口參數(shù)：無(wú)
  107. 出口參數(shù): 無(wú)
  108. 說(shuō)明：QX_A11智能小車停車
  109. **********************************************/
  110. void stop(void)
  111. {
  112.         left_motor_stops;
  113.         right_motor_stops;
  114. }

  116. /*====================================
  117. 函數(shù)：void Delay_Ms(INT16U ms)
  118. 參數(shù)：ms，毫秒延時(shí)形參
  119. 描述：12T 51單片機(jī)自適應(yīng)主時(shí)鐘毫秒級(jí)延時(shí)函數(shù)
  120. ====================================*/
  121. void Delay_Ms(unsigned int ms)
  122. {
  123.      unsigned int i;
  124.          do{
  125.               i = MAIN_Fosc / 96000;
  126.                   while(--i);   //96T per loop
  127.      }while(--ms);
  128. }

  130. /*舵機(jī)方波延時(shí)朝向小車正前方*/
  131. void Delay1550us()                //@11.0592MHz
  132. {
  133.         unsigned char i, j;

  135.         i = 3;
  136.         j = 196;
  137.         do
  138.         {
  139.                 while (--j);
  140.         } while (--i);
  141. }

  143. void Delay18450us()                //@11.0592MHz
  144. {
  145.         unsigned char i, j;

  147.         _nop_();
  148.         i = 34;
  149.         j = 16;
  150.         do
  151.         {
  152.                 while (--j);
  153.         } while (--i);
  154. }
  155. /*舵機(jī)方波延時(shí)向小車右方*/
  156. void Delay600us()                //@11.0592MHz
  157. {
  158.         unsigned char i, j;

  160.         _nop_();
  161.         i = 2;
  162.         j = 15;
  163.         do
  164.         {
  165.                 while (--j);
  166.         } while (--i);
  167. }
  168. void Delay19400us()                //@11.0592MHz
  169. {
  170.         unsigned char i, j;

  172.         _nop_();
  173.         i = 35;
  174.         j = 197;
  175.         do
  176.         {
  177.                 while (--j);
  178.         } while (--i);
  179. }
  180. /*舵機(jī)方波延時(shí)朝向小車左方*/
  181. void Delay17500us()                //@11.0592MHz
  182. {
  183.         unsigned char i, j;

  185.         i = 32;
  186.         j = 93;
  187.         do
  188.         {
  189.                 while (--j);
  190.         } while (--i);
  191. }
  192. void Delay2500us()                //@11.0592MHz
  193. {
  194.         unsigned char i, j;

  196.         i = 5;
  197.         j = 120;
  198.         do
  199.         {
  200.                 while (--j);
  201.         } while (--i);
  202. }
  203. /*********************************************
  204. QX_A11智能小車PWM輸出
  205. 入口參數(shù)：無(wú)
  206. 出口參數(shù): 無(wú)
  207. 說(shuō)明：裝載PWM輸出,如果設(shè)置全局變量pwm_left,pwm_right分別配置左右輸出高電平時(shí)間
  208. **********************************************/
  209. void LoadPWM(void)
  210. {
  211.         if(pwm_left > PWM_HIGH_MAX)                pwm_left = PWM_HIGH_MAX;        //如果左輸出寫(xiě)入大于最大占空比數(shù)據(jù)，則強(qiáng)制為最大占空比。
  212.         if(pwm_left < PWM_HIGH_MIN)                pwm_left = PWM_HIGH_MIN;        //如果左輸出寫(xiě)入小于最小占空比數(shù)據(jù)，則強(qiáng)制為最小占空比。
  213.         if(pwm_right > PWM_HIGH_MAX)        pwm_right = PWM_HIGH_MAX;        //如果右輸出寫(xiě)入大于最大占空比數(shù)據(jù)，則強(qiáng)制為最大占空比。
  214.         if(pwm_right < PWM_HIGH_MIN)        pwm_right = PWM_HIGH_MIN;        //如果右輸出寫(xiě)入小于最小占空比數(shù)據(jù)，則強(qiáng)制為最小占空比。
  215.         if(pwm_val_left<=pwm_left)                Left_moto_pwm = 1;  //裝載左PWM輸出高電平時(shí)間
  216.         else Left_moto_pwm = 0;                                                     //裝載左PWM輸出低電平時(shí)間
  217.         if(pwm_val_left>=PWM_DUTY)                pwm_val_left = 0;        //如果左對(duì)比值大于等于最大占空比數(shù)據(jù)，則為零

  219.         if(pwm_val_right<=pwm_right)        Right_moto_pwm = 1; //裝載右PWM輸出高電平時(shí)間
  220.         else Right_moto_pwm = 0;                                                         //裝載右PWM輸出低電平時(shí)間
  221.         if(pwm_val_right>=PWM_DUTY)                pwm_val_right = 0;        //如果右對(duì)比值大于等于最大占空比數(shù)據(jù)，則為零
  222. }
  223. //冒泡排序
  224. void QXMBOT_bubble(unsigned int *a,unsigned char n) /*定義兩個(gè)參數(shù)：數(shù)組首地址與數(shù)組大小*/
  225. {
  226.         unsigned int i,j,temp;        
  227.         for(i = 0;i < n-1; i++)        
  228.         {        
  229.                 for(j = i + 1; j < n; j++) /*注意循環(huán)的上下限*/
  230.                 {
  231.                         if(a[i] > a[j])
  232.                         {
  233.                                 temp = a[i];               
  234.                                 a[i] = a[j];               
  235.                                 a[j] = temp;                        
  236.                         }
  237.                 }
  238.         }

  240. }
  241. /*====================================
  242. 函數(shù)名        ：QXMBOT_RefreshDistance
  243. 參數(shù)        ：無(wú)
  244. 返回值        ：經(jīng)過(guò)冒泡排序后的距離
  245. 描述        ：經(jīng)過(guò)5次測(cè)距，去除最大值和最小值，取中間3次平均值
  246. 距離單位：毫米
  247. ====================================*/
  248. unsigned int QXMBOT_RefreshDistance()
  249. {
  250.         unsigned char num;
  251.         unsigned int Dist;
  252.         for(num=0; num<5; num++)
  253.         {
  254.                 DistBuf[num] = QXMBOT_GetDistance();
  255.                 Delay_Ms(60);//測(cè)距周期不低于60毫秒        
  256.         }
  257.         QXMBOT_bubble(DistBuf, 5);//
  258.         Dist = (DistBuf[1]+DistBuf[2]+DistBuf[3])/3; //去掉最大和最小取中間平均值
  259.         return(Dist);
  260. }
  261. /*超聲波觸發(fā)*/
  262. void QXMBOT_TrigUltrasonic()
  263. {
  264.         TrigPin = 0; //超聲波模塊Trig        控制端
  265.         _nop_();
  266.         _nop_();
  267.         _nop_();
  268.         _nop_();
  269.         _nop_();
  270.         TrigPin = 1; //超聲波模塊Trig        控制端
  271.         _nop_();_nop_();_nop_();_nop_();_nop_();
  272.         _nop_();_nop_();_nop_();_nop_();_nop_();
  273.         _nop_();_nop_();_nop_();_nop_();_nop_();
  274.         TrigPin = 0; //超聲波模塊Trig        控制端
  275. }
  276. /*====================================
  277. 函數(shù)名        ：QXMBOT_GetDistance
  278. 參數(shù)        ：無(wú)
  279. 返回值        ：獲取距離單位毫米
  280. 描述        ：超聲波測(cè)距
  281. 通過(guò)發(fā)射信號(hào)到收到回響信號(hào)的時(shí)間測(cè)試距離
  282. 單片機(jī)晶振11.0592Mhz
  283. 注意測(cè)距周期為60ms以上
  284. ====================================*/
  285. unsigned int QXMBOT_GetDistance()
  286. {
  287.         unsigned int Distance = 0;        //超聲波距離
  288.         unsigned int  Time=0;                //用于存放定時(shí)器時(shí)間值
  289.         QXMBOT_TrigUltrasonic();        //超聲波觸發(fā)
  290.         while(!EchoPin);          //判斷回響信號(hào)是否為低電平
  291.         Timer1On;                        //啟動(dòng)定時(shí)器1
  292.         while(EchoPin);                //等待收到回響信號(hào)
  293.         Timer1Off;                        //關(guān)閉定時(shí)器1
  294.         Time=TH1*256+TL1;        //讀取時(shí)間
  295.         TH1=0;
  296.         TL1=0;                                //清空定時(shí)器
  297.     Distance = (float)(Time*1.085)*0.17;//算出來(lái)是MM
  298.         return(Distance);//返回距離                                
  299. }
  300. /*====================================
  301. 函數(shù)名        ：QXMBOT_PTZ_Avoid
  302. 參數(shù)        ：val設(shè)置避障觸發(fā)距離
  303. 返回值        ：無(wú)
  304. 描述        ：智能小車舵機(jī)云臺(tái)避障
  305. 距離單位：毫米
  306. ====================================*/
  307. void  QXMBOT_PTZ_Avoid(unsigned int val)
  308. {
  309.         unsigned int Dis;//距離暫存變量
  310.         Dis = QXMBOT_GetDistance();//獲取超聲波測(cè)距距離,單位：毫米
  311.         if((Dis > 30) && (Dis < val))
  312.         {
  313.                 LED1=0,LED2=0,beep=0;//LED1,2點(diǎn)亮，鳴笛        
  314.                 stop();        //停車
  315.                 Delay_Ms(100);
  316.                 LED1=1,LED2=1,beep=1;//LED1,2熄滅，靜音

  318.                 /*舵機(jī)左轉(zhuǎn)測(cè)距*/
  319.                 QXMBOT_ServoLeft();
  320.                 LeftDistance = QXMBOT_RefreshDistance();

  322.                 /*舵機(jī)右轉(zhuǎn)測(cè)距*/
  323.                 QXMBOT_ServoRight();
  324.                 RightDistance = QXMBOT_RefreshDistance();

  326.                 /*舵機(jī)正前方測(cè)距*/
  327.                 QXMBOT_ServoFront();
  328.                 FrontDistance = QXMBOT_RefreshDistance();
  329.                 if((FrontDistance<100) && (LeftDistance<100) && (RightDistance<100))
  330.                 {
  331.                         do{
  332.                                 left_run(160, 160);//原地左轉(zhuǎn)
  333.                                 Delay_Ms(60);
  334.                                 /*舵機(jī)正前方測(cè)距*/
  335.                                 QXMBOT_ServoFront();
  336.                                 Dis = QXMBOT_RefreshDistance();               
  337.                         }while(Dis < 200);
  338.                 }else if((FrontDistance>LeftDistance) && (FrontDistance>RightDistance))
  339.                 {
  340.                         stop();        //停車
  341.                         Delay_Ms(100);
  342.                         forward(120, 120);//前進(jìn)
  343.                 }else if(LeftDistance > RightDistance)
  344.                 {
  345.                         LED1=1,LED2=0;//LED1滅,2點(diǎn)亮
  346.                         stop();        //停車
  347.                         Delay_Ms(100);
  348.                         left_run(160, 160);//原地左轉(zhuǎn)
  349.                         Delay_Ms(60);
  350.                         LED1=1,LED2=1;//LED1滅,2點(diǎn)滅               
  351.                 }else if(RightDistance > LeftDistance)
  352.                 {
  353.                         LED1=0,LED2=1;//LED1亮,2點(diǎn)滅
  354.                         stop();        //停車
  355.                         Delay_Ms(100);
  356.                         right_run(160, 160);//原地右轉(zhuǎn)
  357.                         Delay_Ms(60);
  358.                         LED1=1,LED2=1;//LED1滅,2點(diǎn)滅        
  359.                 }               
  360.         }
  361.         else
  362.         {
  363.                 forward(120, 120);//前進(jìn)
  364.                 Delay_Ms(60);        
  365.         }                        
  366. }
  367. /*=================================================
  368. *函數(shù)名稱：QXMBOT_ServoFront
  369. *函數(shù)功能：云臺(tái)向前轉(zhuǎn)動(dòng)
  370. *調(diào)用：
  371. *輸入：
  372. =================================================*/
  373. void QXMBOT_ServoFront()
  374. {
  375.         char i;
  376.         EA_off;        //關(guān)閉中斷否則會(huì)影響舵機(jī)轉(zhuǎn)向
  377.         for(i=0;i<10;i++)
  378.         {        
  379.                 ServoPin = 1;
  380.                 Delay1550us();
  381.                 ServoPin = 0;
  382.                 Delay18450us();
  383.         }
  384.         EA_on;        //開(kāi)中斷
  385.         Delay_Ms(100);
  386. }
  387. /*=================================================
  388. *函數(shù)名稱：QXMBOT_ServoLeft
  389. *函數(shù)功能：云臺(tái)向左轉(zhuǎn)動(dòng)
  390. *調(diào)用：
  391. *輸入：
  392. =================================================*/
  393. void QXMBOT_ServoLeft()
  394. {
  395.         char i;
  396.         EA_off;        //關(guān)閉中斷否則會(huì)影響舵機(jī)轉(zhuǎn)向
  397.         for(i=0;i<10;i++)
  398.         {        
  399.                 ServoPin = 1;
  400.                 Delay2500us();
  401.                 ServoPin = 0;
  402.                 Delay17500us();
  403.         }
  404.         EA_on;        //開(kāi)中斷
  405.         Delay_Ms(100);
  406. }
  407. /*=================================================
  408. *函數(shù)名稱：QXMBOT_ServoFront
  409. *函數(shù)功能：云臺(tái)向右轉(zhuǎn)動(dòng)
  410. *調(diào)用：
  411. *輸入：
  412. =================================================*/
  413. void QXMBOT_ServoRight()
  414. {
  415.         char i;
  416.         EA_off;        //關(guān)閉中斷否則會(huì)影響舵機(jī)轉(zhuǎn)向
  417.         for(i=0;i<10;i++)
  418.         {        
  419.                 ServoPin = 1;
  420.                 Delay600us();
  421.                 ServoPin = 0;
  422.                 Delay19400us();
  423.         }
  424.         EA_on;        //開(kāi)中斷
  425.         Delay_Ms(100);
  426. }
  427. /********************* Timer0初始化************************/
  428. void Timer0_Init(void)
  429. {
  430.         TMOD |= 0x02;//定時(shí)器0，8位自動(dòng)重裝模塊
  431.         TH0 = 164;
  432.         TL0 = 164;//11.0592M晶振，12T溢出時(shí)間約等于100微秒
  433.         TR0 = 1;//啟動(dòng)定時(shí)器0
  434.         ET0 = 1;//允許定時(shí)器0中斷        
  435. }
  436. /*定時(shí)器1初始化*/
  437. void Timer1_Init(void)               
  438. {
  439.         TMOD |= 0x10;        //定時(shí)器1工作模式1,16位定時(shí)模式。T1用測(cè)ECH0脈沖長(zhǎng)度
  440.         TH1 = 0;                  
  441.     TL1 = 0;
  442.         ET1 = 1;             //允許T1中斷
  443. }

  445. /********************* Timer0中斷函數(shù)************************/
  446. void timer0_int (void) interrupt 1
  447. {
  448.          pwm_val_left++;
  449.          pwm_val_right++;
  450.          LoadPWM();//裝載PWM輸出
  451. }
  452. /* Timer0 interrupt routine */
  453. void tm1_isr() interrupt 3 using 1
  454. {
  455.         Timer1Overflow = 1;        //計(jì)數(shù)器1溢出標(biāo)志位
  456.         EchoPin = 0;                //超聲波接收端        
  457. }        
復(fù)制代碼
代碼下載: 智能小車I套餐舵機(jī)云臺(tái)避障資料.7z (17.3 MB, 下載次數(shù): 107)

作者: dj3365191    時(shí)間: 2021-5-5 18:26
你好樓主，附件里除了程序以外有原理圖嗎
作者: 賊六的噠噠噠    時(shí)間: 2021-5-6 20:11
dj3365191 發(fā)表于 2021-5-5 18:26
你好樓主，附件里除了程序以外有原理圖嗎

有一部分
作者: 15038217543    時(shí)間: 2021-6-21 11:42
這個(gè)有流程圖不？
作者: zk    時(shí)間: 2021-6-22 22:26
擦墻現(xiàn)象有嗎，有解決方案嗎。
作者: 51_chuan    時(shí)間: 2022-5-6 09:48
你好，請(qǐng)問(wèn)可以提供一下 <QX_A11.h>//QX_A11智能小車配置文件 這個(gè)文件的代碼嗎？ 新手幣不夠，下載不了
作者: 亂世狂魔    時(shí)間: 2022-5-7 23:08
這個(gè)是需要用KeilMDK編輯嗎大佬？



歡迎光臨 (http://www.torrancerestoration.com/bbs/) Powered by Discuz! X3.1