找回密碼
 立即注冊(cè)

QQ登錄

只需一步,快速開(kāi)始

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

單片機(jī)直流電機(jī)測(cè)速液晶顯示

[復(fù)制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
在proteus中使用motor_encoder打算之間測(cè)出直流電機(jī)的速度,但是可能我沒(méi)太明白怎么使用這個(gè),不知道怎么對(duì)電機(jī)的脈沖進(jìn)行計(jì)數(shù),參考了網(wǎng)上的程序,改了之后的效果目前是這樣的。電機(jī)也不能正常轉(zhuǎn)了。

當(dāng)前程序運(yùn)行效果.jpg (251.33 KB, 下載次數(shù): 41)

效果圖

效果圖

motortest.zip

1.91 KB, 下載次數(shù): 21

代碼部分

分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏 分享淘帖 頂 踩
回復(fù)

使用道具 舉報(bào)

沙發(fā)
ID:123289 發(fā)表于 2023-5-20 08:33 | 只看該作者
先仔細(xì)閱讀你用到的元件的手冊(cè),而后問(wèn)題就基本解決了。
還有不懂的,可以教教你。
回復(fù)

使用道具 舉報(bào)

板凳
ID:908826 發(fā)表于 2023-5-20 13:03 | 只看該作者
我沒(méi)看明白里面這個(gè)rad轉(zhuǎn)速變量為什么是外部中斷脈沖數(shù)*可調(diào)增益,這是在試錯(cuò),然后計(jì)算轉(zhuǎn)速?
回復(fù)

使用道具 舉報(bào)

地板
ID:1076306 發(fā)表于 2023-5-20 14:27 | 只看該作者
13205495918 發(fā)表于 2023-5-20 13:03
我沒(méi)看明白里面這個(gè)rad轉(zhuǎn)速變量為什么是外部中斷脈沖數(shù)*可調(diào)增益,這是在試錯(cuò),然后計(jì)算轉(zhuǎn)速?

其實(shí)我也不太理解,是參考了這個(gè)文章https://blog.csdn.net/m0_51283747/article/details/128438669
回復(fù)

使用道具 舉報(bào)

5#
ID:908826 發(fā)表于 2023-5-20 19:17 | 只看該作者
小森林湖 發(fā)表于 2023-5-20 14:27
其實(shí)我也不太理解,是參考了這個(gè)文章https://blog.csdn.net/m0_51283747/article/details/128438669

果然是用文章中的轉(zhuǎn)速計(jì)算公式自己算的,然后又在該值上微調(diào)
回復(fù)

使用道具 舉報(bào)

6#
ID:1076306 發(fā)表于 2023-5-20 22:40 | 只看該作者
  1. //開(kāi)機(jī)直流電機(jī)不轉(zhuǎn),按K1正轉(zhuǎn),K2停止,液晶顯示實(shí)時(shí)轉(zhuǎn)速,單位cm/s,12v速度約5cm/s,5v速度約1.4cm/s

  2. #include <STC15.H>
  3. #include "DataForm_STC15.H"
  4. #include "LCD1602.h"
  5. #include <stdio.h>
  6.        
  7. #define MOTOR_A1 P12                       
  8. #define MOTOR_A2 P13

  9. #define KEY1 P34                                       
  10. #define KEY2 P35
  11. #define KEY3 P54
  12. #define KEY4 P55

  13. uint32 EX0_counter=0;                // 無(wú)符號(hào)32位整形變量,記錄T0中斷次數(shù)
  14. uint16 Timer1S_num=0;                // 定時(shí)器溢出中斷計(jì)數(shù),一千次為1S
  15. bit Timer1S_flag=0;                        // 定時(shí)器到1S標(biāo)志位
  16. uchar8 LCD_BUFFER[16]={0};                // 液晶顯示緩沖區(qū)
  17. fp32 Speed=0;                        // 浮點(diǎn)變量電機(jī)轉(zhuǎn)速

  18. void Init_MOTOR( )                       
  19. {
  20.         P1M0&=0x00;               
  21.         P1M1&=0x00;
  22. }

  23. void Init_KEY( )                       
  24. {
  25.         P3M0&=0x00;                       
  26.         P3M1&=0x00;
  27.         P5M0&=0x00;                       
  28.         P5M1&=0x00;
  29. }

  30. void Motor_Forward( )                       
  31. {
  32.         MOTOR_A1=0;                                       
  33.             MOTOR_A2=1;
  34. }

  35. void Motor_Stop( )               
  36. {
  37.         MOTOR_A1=1;                                       
  38.            MOTOR_A2=1;
  39. }

  40. void KEY_Scan( )                //掃描按鍵子程序
  41. {
  42.         if(KEY1==0)                       
  43.         {
  44.                 Motor_Forward( );
  45.         }
  46.         else        if(KEY2==0)               
  47.         {
  48.                 Motor_Stop( );
  49.         }
  50. }       

  51. void Init_EINT0( )                // T0外部中斷初始化
  52. {
  53.         IT0=1;                // 外部信號(hào)下降沿觸發(fā)
  54.         EX0=1;                // 開(kāi)T0外部中斷
  55.         EA=1;                // 開(kāi)總中斷
  56. }

  57. void EINT0( ) interrupt 0        // T0外部中斷子程序
  58. {
  59.         EX0_counter++;        // 每中斷一次計(jì)數(shù)加1
  60. }

  61. void Init_Timer1( )                // 定時(shí)器T1初始化       
  62. {
  63.         AUXR |= 0x40;        // 定時(shí)器時(shí)鐘為1T模式
  64.         TMOD &= 0x0F;        // 設(shè)置定時(shí)器模式,16位自動(dòng)重裝
  65.         TL1 = 0xCD;        // 定時(shí)常數(shù)
  66.         TH1 = 0xD4;        // 定時(shí)常數(shù)
  67.         TF1 = 0;                // 清溢出標(biāo)志位
  68.         ET1=1;                // 開(kāi)T1溢出中斷
  69.         EA=1;                // 開(kāi)總中斷
  70. }

  71. void Enable_Timer1( )        //開(kāi)定時(shí)器
  72. {
  73.         TR1=1;
  74. }

  75. void Disable_Timer1( )        //關(guān)定時(shí)器
  76. {
  77.         TR1=0;
  78. }

  79. void Timer1( ) interrupt 3                // T1中斷子程序
  80. {
  81.         Timer1S_num++;                // 定時(shí)器溢出中斷計(jì)數(shù),每中斷一次計(jì)數(shù)加1
  82.         TF1 = 0;                        // 清溢出標(biāo)志位
  83.         if(Timer1S_num>=1000)        // 中斷計(jì)數(shù)一千次為1S,到1S計(jì)數(shù)清零,1S標(biāo)志位置1,即每1S檢測(cè)一次
  84.         {
  85.                 Timer1S_num=0;
  86.                 Timer1S_flag=1;       
  87.         }
  88. }

  89. void main( )                        // 主程序
  90. {                               
  91.         Init_MOTOR( );       
  92.         Init_KEY( );       
  93.         LCD_Init( );       
  94.         LCD_Display_String(4,0,"MOTOR DC");
  95.         Init_EINT0( );
  96.         Init_Timer1( );
  97.         Enable_Timer1( );
  98.        
  99.         while(1)
  100.         {       
  101.                 KEY_Scan( );       
  102.                 if(Timer1S_flag==1)                                // 如果時(shí)間到1S
  103.                 {
  104.                         Speed=(0.508*EX0_counter)/50;                // 速度公式               
  105.                         sprintf(LCD_BUFFER,"Speed=%.2fcm/s",Speed);        // 顯示小數(shù)點(diǎn)后兩位       
  106.                         LCD_Display_String(1,1,LCD_BUFFER);                // 液晶顯示
  107.                         EX0_counter=0;                                // 外部中斷計(jì)數(shù)清零
  108.                         Timer1S_flag=0;                                // 1S計(jì)數(shù)清零
  109.                 }
  110.         }
  111. }

  112. //該型號(hào)光電編碼器每轉(zhuǎn)一圈A相產(chǎn)生600個(gè)脈沖,編碼器同步輪12個(gè)齒,齒間距5.08mm,
  113. //故v=L/t,L=5.08*12*EX0_counter/600,t=1S,所以v=5.08*12*EX0_counter/600*1 = 0.508*EX0_counter/50  cm/s;
復(fù)制代碼
回復(fù)

使用道具 舉報(bào)

7#
ID:1076306 發(fā)表于 2023-5-20 22:48 | 只看該作者
yzwzfyz 發(fā)表于 2023-5-20 08:33
先仔細(xì)閱讀你用到的元件的手冊(cè),而后問(wèn)題就基本解決了。
還有不懂的,可以教教你。

參考了之前實(shí)驗(yàn)課上老師講的編碼器的程序,但我還是理解的不太清楚,也不確定我的連線(xiàn)是否正確,可以給我再講講嗎。我理解是利用定時(shí)器0去對(duì)脈沖進(jìn)行計(jì)數(shù),確定電機(jī)轉(zhuǎn)動(dòng)的圈數(shù),T1用來(lái)每1s檢測(cè)一次,然后利用液晶顯示速度。但把這部分加進(jìn)我的程序中,好像沒(méi)有效果。
  1. //#include <reg52.h>
  2. #include <STC15.H>
  3. #include <intrins.h>
  4. #include <stdio.h>
  5. #include "DataForm_STC15.H"
  6. #include "LCD1602.h"
  7. #define uchar unsigned char
  8. #define uint unsigned int
  9. #define K 21/8

  10. sbit KEY1=P1^0;// 電機(jī)啟動(dòng)
  11. sbit KEY2=P1^1;// 電機(jī)停止
  12. sbit KEY3=P1^2;// 電機(jī)加速
  13. sbit KEY4=P1^3;  //減速

  14. bit KEY_flag=0;         //按鍵標(biāo)志位
  15. bit Timer1S_flag=0;                        // 定時(shí)器到1S標(biāo)志位
  16. uint16 Timer1S_num=0;                // 定時(shí)器溢出中斷計(jì)數(shù),一千次為1S
  17. uint count = 0;          //計(jì)時(shí)變量
  18. uint PWM = 0;   //占空比控制變量
  19. uint EX0_counter=0,rad;//EX0_counter為脈沖數(shù)
  20. uchar8 LCD_BUFFER[16]={0};        // 液晶顯示緩沖區(qū)

  21. sbit MOTOR_A1=P1^4; //l293D芯片引腳定義
  22. sbit MOTOR_A2=P1^5;
  23. sbit MOTOR_B1=P1^6;
  24. sbit MOTOR_B2=P1^7;
  25. sbit ENA=P3^0;
  26. sbit ENB=P3^1;


  27. void delay1ms()                //@11.0592MHz延時(shí)函數(shù)
  28. {
  29.         unsigned char i, j;

  30.         _nop_();
  31.         _nop_();
  32.         _nop_();
  33.         i = 11;
  34.         j = 190;
  35.         do
  36.         {
  37.                 while (--j);
  38.         } while (--i);
  39. }


  40. void delayms(uint t) //1ms延時(shí)函數(shù)
  41. {
  42.         uint x,y;
  43.         for(x=t;x>0;x--)
  44.                 for(y=120;y>0;y--);
  45. }

  46. void Motor_Forward()//電機(jī)正轉(zhuǎn)
  47. {
  48.         MOTOR_A1=1;                 
  49.         MOTOR_A2=0;
  50.         ENA=1;
  51.         MOTOR_B1=1;                 
  52.         MOTOR_B2=0;
  53.         ENB=1;
  54. }
  55.        
  56. void Motor_Stop()//電機(jī)停止
  57. {
  58.         MOTOR_A1=0;                 
  59.         MOTOR_A2=0;
  60.         ENA=1;
  61.         MOTOR_B1=0;                 
  62.         MOTOR_B2=0;
  63.         ENB=1;
  64. }

  65. void Start()
  66. {
  67.         LCD_Init();
  68.         LCD_Display_String(4,0,"Treadmill");
  69. }

  70. void Speed_Up()
  71. {
  72.         LCD_Init();
  73.         LCD_Display_String(4,0,"speed up");
  74. }

  75. void Speed_Down()
  76. {
  77.         LCD_Init();
  78.         LCD_Display_String(4,0,"speed down");
  79. }

  80. void KEY_Scan()           // 按鍵驅(qū)動(dòng)函數(shù)
  81. {
  82.         if(KEY1==0)          // 判斷是否按下  下同
  83.         {
  84.                 delay1ms(); //消抖
  85.                 if(KEY1==0)
  86.                 {
  87.                         KEY_flag=~KEY_flag;  //加速減速標(biāo)志位取反
  88.                         Motor_Forward();
  89.                         PWM=30;                //初始PWM=30,電機(jī)速度大約為22
  90.        
  91.                 }
  92.                 while(KEY1==0); //檢測(cè)按鍵是否松開(kāi)
  93.         }

  94.         if(KEY2==0)          // 判斷是否按下  下同
  95.         {
  96.                 delay1ms(); //消抖
  97.                 if(KEY2==0)
  98.                 {
  99.                         KEY_flag=0;        //加速減速標(biāo)志位清零
  100.                         Motor_Stop();
  101.                         PWM=0;                //PWM清零
  102.                
  103.                 }
  104.                 while(KEY2==0); //檢測(cè)按鍵是否松開(kāi)
  105.         }

  106.         if(KEY3==0)          // 判斷是否按下  下同
  107.         {
  108.                 delay1ms(); //消抖
  109.                 if(KEY3==0)
  110.                 {
  111.                         if(KEY_flag==1)         //判斷標(biāo)志位只有在電機(jī)啟動(dòng)的時(shí)候才能加速
  112.                         {
  113.                                 if(PWM<250)
  114.                                 {
  115.                                         Speed_Up();
  116.                                         PWM=PWM+30; //每次PWM+10  直到250
  117.                                 }
  118.                                 delayms(10); //給一個(gè)延時(shí),讓電機(jī)反應(yīng)快一些可減少此延時(shí)時(shí)間
  119.                         }

  120.                 }
  121.                 while(KEY3==0); //檢測(cè)按鍵是否松開(kāi)
  122.         }

  123.         if(KEY4==0)          // 判斷是否按下  下同
  124.         {
  125.                 delay1ms(); //消抖
  126.                 if(KEY4==0)
  127.                 {
  128.                         if(KEY_flag==1) //判斷標(biāo)志位只有在電機(jī)啟動(dòng)的時(shí)候才能減速
  129.                         {       
  130.                                 if(PWM>0)
  131.                                 {
  132.                                         Speed_Down();
  133.                                         PWM=PWM-30;
  134.                                 }
  135.                                 delayms(10);
  136.                         }
  137.                 }
  138.                 while(KEY4==0); //檢測(cè)按鍵是否松開(kāi)
  139.         }
  140. }


  141. void Timer0()
  142. {
  143.     TMOD = 0x02;   //定時(shí)器0,工作模式2,8位定時(shí)模式
  144.         TH0=210;     //寫(xiě)入預(yù)置初值(取值1-255,數(shù)越大PWM頻率越高)
  145.         TL0=210;     //寫(xiě)入預(yù)置值 (取值1-255,數(shù)越大PWM頻率越高)
  146.         TR0=1;       //啟動(dòng)定時(shí)器
  147.         ET0=1;       //允許定時(shí)器0中斷
  148.         EA=1;        //允許總中斷

  149. }

  150. //定時(shí)器0中斷模擬PWM
  151. void serviceTimer0() interrupt 1  
  152. {
  153.          count++;    //每次定時(shí)器溢出加1
  154.          if(count==250)   //PWM周期 100個(gè)單位
  155.                  {
  156.                           count=0;  //使t=0,開(kāi)始新的PWM周期
  157.                           Motor_Forward();
  158.                  }
  159.          
  160.          if(PWM==count)  //按照當(dāng)前占空比切換輸出為低電平
  161.                  {  
  162.                         Motor_Stop();
  163.                  }
  164. }

  165. void Init_EINT0( )                // T0外部中斷初始化
  166. {
  167.         IT0=1;                // 外部信號(hào)下降沿觸發(fā)
  168.         EX0=1;                // 開(kāi)T0外部中斷
  169.         EA=1;                // 開(kāi)總中斷
  170. }

  171. void EINT0( ) interrupt 0        // T0外部中斷子程序
  172. {
  173.         EX0_counter++;        // 每中斷一次計(jì)數(shù)加1
  174. }


  175. void Init_Timer1( )                // 定時(shí)器T1初始化       
  176. {
  177.         AUXR |= 0x40;        // 定時(shí)器時(shí)鐘為1T模式
  178.         TMOD &= 0x0F;        // 設(shè)置定時(shí)器模式,16位自動(dòng)重裝
  179.         TL1 = 0xCD;        // 定時(shí)常數(shù)
  180.         TH1 = 0xD4;        // 定時(shí)常數(shù)
  181.         TF1 = 0;                // 清溢出標(biāo)志位
  182.         ET1=1;                // 開(kāi)T1溢出中斷
  183.         EA=1;                // 開(kāi)總中斷
  184. }

  185. void Enable_Timer1( )        //開(kāi)定時(shí)器
  186. {
  187.         TR1=1;
  188. }

  189. void Disable_Timer1( )        //關(guān)定時(shí)器
  190. {
  191.         TR1=0;
  192. }

  193. void Timer1( ) interrupt 3                // T1中斷子程序
  194. {
  195.         Timer1S_num++;                // 定時(shí)器溢出中斷計(jì)數(shù),每中斷一次計(jì)數(shù)加1
  196.         TF1 = 0;                        // 清溢出標(biāo)志位
  197.         if(Timer1S_num>=1000)        // 中斷計(jì)數(shù)一千次為1S,到1S計(jì)數(shù)清零,1S標(biāo)志位置1,即每1S檢測(cè)一次
  198.         {
  199.                 Timer1S_num=0;
  200.                 Timer1S_flag=1;       
  201.         }
  202. }


  203. void Speed_Display()              //計(jì)算速度
  204. {
  205.         rad=EX0_counter*K;
  206.         sprintf(LCD_BUFFER,"v=%.2f",rad);
  207.         LCD_Display_String(2,1,LCD_BUFFER);
  208. }

  209. void main()
  210. {
  211.         Start();//初始化顯示跑步機(jī)
  212.         Timer0();//定時(shí)器0初始化
  213.         Init_Timer1( );//定時(shí)器1初始化
  214.         Enable_Timer1( );
  215.         Init_EINT0( );  //電機(jī)編碼器中斷初始化
  216.         EX0_counter=0;        //電機(jī)旋轉(zhuǎn)圈數(shù)初始化
  217.         Timer1S_num=0;        //計(jì)時(shí)次數(shù)初始化
  218.         Motor_Forward();//啟動(dòng)電機(jī)
  219. //        PWM=30;         //PWM初始值
  220.        
  221.     while(1)
  222.     {
  223.               KEY_Scan();
  224.                 if(Timer1S_flag==1)                                // 如果時(shí)間到1S
  225.                 {
  226.                         Speed_Display();                // 液晶顯示
  227.                         EX0_counter=0;                                // 外部中斷計(jì)數(shù)清零
  228.                         Timer1S_flag=0;                                // 1S計(jì)數(shù)清零
  229.                 }
  230.                
  231.     }
  232. }
復(fù)制代碼

回復(fù)

使用道具 舉報(bào)

8#
ID:1106874 發(fā)表于 2023-12-28 19:39 | 只看該作者
大哥有程序文件嗎,參考參考
回復(fù)

使用道具 舉報(bào)

本版積分規(guī)則

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

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

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