標(biāo)題: 51單片機(jī)pwm控制電機(jī)速度正反轉(zhuǎn)(終極版)函數(shù)都已寫(xiě)好直接調(diào)用 [打印本頁(yè)]
作者: 大紅色九分褲    時(shí)間: 2017-10-31 21:06
標(biāo)題: 51單片機(jī)pwm控制電機(jī)速度正反轉(zhuǎn)(終極版)函數(shù)都已寫(xiě)好直接調(diào)用


用51單片機(jī)做的滅火機(jī)器人程序，pwm控制速度正反轉(zhuǎn)，能夠?qū)崿F(xiàn)自動(dòng)尋找火源并滅火。此機(jī)器人在電子競(jìng)賽中獲

單片機(jī)源程序如下:
  1. #include<reg52.h>
  2. #include<math.h>
  3. #include<math.h>
  4. #define uint unsigned int
  5. #define uchar unsigned char


  8. sbit IN_L1=P1^3;             //左輪電機(jī)控制1       //
  9. sbit IN_L2=P1^2;             //左輪電機(jī)控制2       //
  10. sbit IN_R1=P1^0;             //右輪電機(jī)控制1       //
  11. sbit IN_R2=P1^1;             //右輪電機(jī)控制2            //
  12. sbit PWMA=P1^6;              //左輪電機(jī)PWM波輸出  //
  13. sbit PWMB=P1^5;              //右輪電機(jī)PWM波輸出          //

  15. sbit HONG_L=P3^0;
  16. sbit HONG_M=P3^1;
  17. sbit HONG_R=P3^2;                                //紅外避障，左，中，右
  18.   
  19. sbit S_L=P3^4;
  20. sbit S_R=P3^5;                                  //尋跡傳感器，
  21. sbit J_L=P3^6;
  22. sbit J_R=P3^7;                                        //計(jì)數(shù)器，左輪，右輪

  24. sbit DJ=P0^0;                           //        電機(jī)
  25. sbit SPK=P2^1;                        //蜂鳴器
  26. sbit HUO_L=P2^3;
  27. sbit HUO_R=P2^4;                        //探測(cè)到火源 ，為低電位

  29. uchar SpeedTemp1=0;          //左輪電機(jī)速度鎖定變量
  30. uchar SpeedTemp2=0;          //右輪電機(jī)速度鎖定變量

  32. uchar SpeedLeft=0;          //左輪電機(jī)速度設(shè)定變量
  33. uchar SpeedRight=0;          //右輪電機(jī)速度設(shè)定變量

  35. uchar Timer0=0;           //定時(shí)器T0中斷次數(shù)計(jì)數(shù)變量
  36. uint i,j,k,n;

  38. void Motor(uchar Select,char Speed)   //Select為電機(jī)選擇，左輪為1，右輪為2                                  //Description:電機(jī)速度,正反轉(zhuǎn)傳遞程序            
  39. {
  40.    if(Select==1)                      //對(duì)左輪電機(jī)的處理
  41.    {
  42.       SpeedLeft=abs(Speed);              //取速度的絕對(duì)值
  43.       if(Speed>=0)
  44.       {
  45.          IN_L1=0;
  46.          IN_L2=1;                     //如果速度為非負(fù)，則正轉(zhuǎn)
  47.          }
  48.       else
  49.       {
  50.          IN_L1=1;
  51.          IN_L2=0;                     //如果速度為負(fù)，則反轉(zhuǎn)      
  52.       }
  53.    }

  55.    if(Select==2)                      //對(duì)右輪電機(jī)的處理
  56.    {
  57.       SpeedRight=abs(Speed);              //取速度的絕對(duì)值
  58.       if(Speed>=0)
  59.       {
  60.          IN_R1=0;
  61.          IN_R2=1;                     //如果速度為非負(fù)，則正轉(zhuǎn)
  62.          }
  63.       else
  64.       {
  65.          IN_R1=1;
  66.          IN_R2=0;                     //如果速度為負(fù)，則反轉(zhuǎn)      
  67.       }
  68.    }

  70. }
  71. void Delay(uint n)   //Delay范圍0 ~ 65535
  72. {
  73.    uint j;
  74.    while(n--!=0)         //延時(shí)次數(shù)
  75.    {
  76.       for(j=0;j<110;j++)    //延時(shí)1ms
  77.            ;
  78.    }
  79. }                           //總延時(shí)為Delay*1 ms


  82. void H_detect()
  83. {
  84.         if(HUO_L==0)
  85.         {       
  86.                 for(i=1;i<640;i++)
  87.                         for(k=1;k<110;k++)
  88.                 {       
  89.                         Motor(1,-50);
  90.                         Motor(2,0);
  91.                         DJ=1;
  92.                         j=1;
  93.                 }
  94.         }
  95.         else
  96.                 if(HUO_R==0)
  97.                 {
  98.                         for(i=1;i<640;i++)
  99.                                 for(k=1;k<110;k++)
  100.                                 {
  101.                                 Motor(1,0);
  102.                                 Motor(2,-50);
  103.                                 DJ=1;
  104.                                 j=2;
  105.                                 }
  106.                 }
  107.                 else
  108.                 {
  109.                         Motor(1,80);
  110.                         Motor(2,80);
  111.                         j=0;
  112.                 }
  113.         if((j==1)||(j==2))
  114.         {        DJ=1;
  115.                 for(i=0;i<500;i++)
  116.                         for(k=1;k<110;k++)
  117.                                 {
  118.                                 Motor(1,0);
  119.                                 Motor(2,0);
  120.                                 }
  121.                 if(j==1)
  122.                 {
  123.                         for(i=1;i<1150;i++)
  124.                                 for(k=1;k<110;k++)
  125.                                 {
  126.                                         Motor(1,50);
  127.                                         Motor(2,0);
  128.                                 }
  129.                 }
  130.                 else
  131.                 {
  132.                         for(i=1;i<1150;i++)
  133.                                 for(k=1;k<110;k++)
  134.                                 {
  135.                                         Motor(1,0);
  136.                                         Motor(2,50);
  137.                                 }                       
  138.                 }
  139.                 DJ=0;
  140.                 Delay(200);
  141.         }       
  142. }

  144. void Move()
  145. {
  146.         H_detect();
  147.         if((S_L==0)&&(S_R!=0))
  148.         {
  149.                 Motor(1,-10);
  150.                 Motor(2,80);
  151.         }
  152.         else
  153.         {
  154.                 if((S_R==0)&&(S_L!=0))
  155.                 {
  156.                         Motor(1,80);
  157.                         Motor(2,-10);
  158.                 }
  159.                 else
  160.                 {if((S_R==0)&&(S_L==0))
  161.                         {
  162.                                 Motor(1,80);
  163.                                 Motor(2,80);
  164.                         }
  165.                 }
  166.         }
  167. //        Delay(100);         
  168.         Motor(1,80);
  169.         Motor(2,80);
  170. }
  171. void Init()
  172. {
  173.    IN_L1=1;            
  174.    IN_L2=1;             //左輪電機(jī)剎車(chē)      
  175.    IN_R1=1;            
  176.    IN_R2=1;             //右輪電機(jī)剎車(chē)      

  178.         PWMA=0;            //左輪電機(jī)PWM波初始化
  179.         PWMB=0;             //右輪電機(jī)PWM波初始化
  180.    
  181.    TMOD=0x01;        // 設(shè)定T0的工作模式為1，GATE=0說(shuō)明以TR0啟動(dòng)定時(shí)器，C/T為0說(shuō)明選擇了定時(shí)模式
  182.    TR0=0;             //關(guān)閉定時(shí)器0
  183.    TF0=0;             //定時(shí)器溢出復(fù)位
  184.    IE=0x00;             //所有中斷關(guān)閉
  185.    TH0=(65536-1000)/256;               
  186.    TL0=(65536-1000)%256;      //裝入TO定時(shí)初值，定時(shí)時(shí)間為50us
  187.    EA=1;             //開(kāi)中斷
  188.    ET0=1;            //開(kāi)定時(shí)器0的中斷   
  189.    TR0=1;            //啟動(dòng)定時(shí)器0
  190. }
  191. void main()
  192. {        Init();
  193.         DJ=0;
  194.         n=1;
  195.         while(n)
  196.         {
  197.                 Motor(1,80);
  198.                 Motor(2,80);
  199.                 if((S_R!=0)&(S_L!=0))
  200.                 {
  201.                         for(i=1;i<95;i++)
  202.                                 for(k=1;k<110;k++)
  203.                                         {
  204.                                                 Motor(1,80);
  205.                                                 Motor(2,0);
  206.                                         }                         //右轉(zhuǎn)九十度
  207.                         n=0;
  208.                 }
  209.         }
  210.         Delay(200);
  211.            for(i=1;i<150;i++)
  212.                 for(k=1;k<110;k++)
  213.                         {
  214.                                 Move();
  215.                         }
  216.         for(i=1;i<180;i++)
  217.                                 for(k=1;k<110;k++)
  218.                                         {
  219.                                                 Motor(1,0);
  220.                                                 Motor(2,80);
  221.                                         }                         //zuo轉(zhuǎn)九十度       
  222.         while(1)
  223.         {
  224.                 Move();
  225.         }       
  226. }
  227. void PwmTimer0() interrupt 1     //定時(shí)器0的中斷服務(wù)程序來(lái)產(chǎn)生PWM波
  228. {     
  229.    TH0=(65536-1000)/256;
  230.    TL0=(65536-1000)%256;        //恢復(fù)定時(shí)器0的初值，定時(shí)時(shí)間50us
  231.    
  232.    if(Timer0==0)         //1個(gè)PWM周期完成后才會(huì)接受新數(shù)值 ,即500us內(nèi)鎖定速度
  233.    {
  234.     SpeedTemp1=SpeedLeft;  //鎖定左輪電機(jī)的速度
  235.     SpeedTemp2=SpeedRight; //鎖定右輪電機(jī)的速度
  236.     }
  237.    
  238.     if(Timer0<SpeedTemp1)
  239.        PWMA=1;
  240.     else
  241.        PWMA=0;       //產(chǎn)生左輪電機(jī)的PWM波
  242.    
  243.     if(Timer0<SpeedTemp2)
  244.        PWMB=1;
  245.     else
  246.        PWMB=0;      //產(chǎn)生右輪電機(jī)的PWM波

  248.     Timer0++;         //中斷計(jì)數(shù)變量增1
  249.     if(Timer0>=100) //設(shè)定PWM波周期為500us
  250.     Timer0=0;       //中斷計(jì)數(shù)變量清0
  251. }
復(fù)制代碼

所有資料51hei提供下載:
用51單片機(jī)做的滅火機(jī)器人程序，能夠?qū)崿F(xiàn)自動(dòng)尋找火源并滅火。此機(jī)器人在電子競(jìng)賽中獲.rar (32.79 KB, 下載次數(shù): 161)


作者: yyyttt_2007    時(shí)間: 2017-11-10 18:25
好資料，51黑有你更精彩!!!
作者: teast_tea    時(shí)間: 2018-5-6 15:15
非常需要,謝謝摟住
作者: bleach    時(shí)間: 2018-5-8 09:23
謝謝分享
作者: ck夏    時(shí)間: 2018-5-8 10:11
謝謝大神
作者: zcmthr    時(shí)間: 2018-7-3 14:53

謝謝分享
作者: wis98    時(shí)間: 2018-9-18 14:36
好資料，51黑有你更精彩!!!
作者: dyx811    時(shí)間: 2018-10-16 18:12
太精彩了，久久不愿離開(kāi)
作者: 好又快維修部    時(shí)間: 2018-10-18 10:30
樓主這是大愛(ài)啊
作者: 秦沐    時(shí)間: 2018-11-14 09:36
完美的51hei
作者: 范飯飯    時(shí)間: 2018-11-16 10:23
大愛(ài)無(wú)言
作者: 笑天我    時(shí)間: 2018-11-19 18:28

大愛(ài)無(wú)言
作者: 夢(mèng)里見(jiàn)回復(fù)    時(shí)間: 2018-11-21 11:07
謝謝分享
作者: li972695398    時(shí)間: 2019-3-28 14:16
感謝分享，能不能看下原理圖
作者: 冰醋混合物    時(shí)間: 2019-4-3 09:56
樓主，你確定 定時(shí)50us話，賦的初值是65536-1000？比如你的是12M晶振，怎么算都是65536-50吧？就算是11.0592的晶振，也絕不可能是這個(gè)數(shù)值。
作者: 絮塵    時(shí)間: 2019-4-26 10:51
請(qǐng)問(wèn)能不能發(fā)下硬件原理圖
作者: sky505050w    時(shí)間: 2019-4-26 12:15
樓主，你這個(gè)PWM里面的速度鎖定變量是為了防止電機(jī)產(chǎn)生沖擊嗎，變速的時(shí)候
作者: hzsstudy    時(shí)間: 2020-4-9 09:19
非常需要,謝謝摟住
作者: mszw2100    時(shí)間: 2020-4-9 10:34

好資料，51黑有你更精彩!!!



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