標(biāo)題: 步進(jìn)電機(jī)控制實(shí)驗(yàn)程序 [打印本頁(yè)]

作者: daming    時(shí)間: 2014-12-30 01:35
標(biāo)題: 步進(jìn)電機(jī)控制實(shí)驗(yàn)程序
  1. #include <reg52.h>       //51芯片管腳定義頭文件
  2. #include <intrins.h>  //內(nèi)部包含延時(shí)函數(shù) _nop_();
  3. unsigned char code FFW[8]={0x01,0x03,0x02,0x06,0x04,0x0c,0x08,0x09}; //正轉(zhuǎn)相序代碼
  4. unsigned char code REV[8]={0x09,0x08,0x0c,0x04,0x06,0x02,0x03,0x01};       //反轉(zhuǎn)相序代碼
  5. sbit  K1   = P3^2;       //正轉(zhuǎn)
  6. sbit  K2   = P3^3;       //反轉(zhuǎn)
  7. sbit  K3   = P3^4;       //停止
  8. sbit  BEEP = P3^6;       //蜂鳴器


  9. /*********************************************************
  10. 1ms延時(shí)
  11. *********************************************************/
  12. void delay(unsigned int t)
  13. {                          
  14.    unsigned int k;
  15.    while(t--)
  16.      for(k=0; k<125; k++);
  17. }

  18. /**********************************************************
  19. 0.1ms延時(shí)
  20.   **********************************************************/
  21. void delayB(unsigned char n)   
  22. {
  23.    unsigned char i;
  24.    while(n--)
  25.      for (i=0; i<13; i++);
  26. }

  27. /**********************************************************/


  28. /*蜂鳴器*/
  29. void beep()
  30. {
  31.   unsigned char i;
  32.   for(i=0;i<100;i++){
  33.   BEEP=~BEEP;
  34.   delayB(4);
  35. }
  36. BEEP=1;
  37. }

  38. /********************************************************/
  39. /*
  40. /*步進(jìn)電機(jī)正轉(zhuǎn)
  41. /*
  42. /********************************************************/
  43. void  motor_ffw()
  44. {
  45.    unsigned char i;
  46.    unsigned int  j;
  47.    for (j=0; j<8; j++)         //轉(zhuǎn)1*n圈
  48.     {
  49.      if(K3==0){
  50.    delay(15); //消陡
  51.    if(K3==0)
  52.     break;
  53.   }                //退出此循環(huán)程序
  54.       for (i=0; i<8; i++)       //一個(gè)周期轉(zhuǎn)45度
  55.         {
  56.           P1 = FFW[i];          //取數(shù)據(jù)
  57.           delay(2);            //調(diào)節(jié)轉(zhuǎn)速
  58.         }
  59.     }
  60. }

  61. /********************************************************/
  62. /*
  63. /*步進(jìn)電機(jī)反轉(zhuǎn)
  64. /*
  65. /********************************************************/
  66. void  motor_rev()
  67. {
  68.      unsigned char i;
  69.   unsigned int  j;
  70.   for (j=0; j<8; j++)       //轉(zhuǎn)1×n圈
  71.       {
  72.       if(K3==0){
  73.    delay(15); //消陡
  74.    if(K3==0)
  75.     break;
  76.   }                //退出此循環(huán)程序
  77.         for (i=0; i<8; i++)     //一個(gè)周期轉(zhuǎn)45度
  78.         {
  79.           P1 = REV[i];          //取數(shù)據(jù)
  80.           delay(2);            //調(diào)節(jié)轉(zhuǎn)速
  81.         }
  82.       }
  83. }

  84. /********************************************************
  85. *                                                      
  86. *  主程序                                             
  87. *                                                     
  88. *********************************************************/

  89. void main()
  90. {

  91.    unsigned char r,N=64;             //N 步進(jìn)電機(jī)運(yùn)轉(zhuǎn)圈數(shù) 因?yàn)椴竭M(jìn)電機(jī)是減速步進(jìn)電機(jī) 減速比是1/64 所以這里N=64時(shí) 步進(jìn)電機(jī)外部的主軸轉(zhuǎn)1圈
  92.    while(1)
  93.     {
  94.       if(K1==0)
  95.    {
  96.     delay(10);
  97.   if(K1==0){
  98.    beep();
  99.       for(r=0;r<N;r++)
  100.             {
  101.          motor_ffw();       //電機(jī)正轉(zhuǎn)
  102.           if(K3==0){
  103.         delay(10);
  104.      if(K3==0){
  105.                beep();
  106.       break;
  107.      }
  108.       }    //退出此循環(huán)程序
  109.       }  
  110.      }
  111.       }
  112.    else if(K2==0)
  113.       {
  114.     delay(10);
  115.   if(K2==0){
  116.         beep();
  117.      for(r=0;r<N;r++)
  118.            {
  119.            motor_rev();       //電機(jī)反轉(zhuǎn)
  120.            if(K3==0){
  121.         delay(10);
  122.      if(K3==0){
  123.                beep();
  124.       break;
  125.      }
  126.          }    //退出此循環(huán)程序
  127.       }
  128.    }
  129.        }
  130.     else
  131.    P1 = 0xf0;    //關(guān)閉電機(jī)
  132. }


  133. }

  134. /********************************************************/

復(fù)制代碼



作者: jk123    時(shí)間: 2015-3-25 22:53
請(qǐng)問(wèn)能給我講解一下有些程序嗎
作者: Yasuo    時(shí)間: 2015-5-11 21:11
樓主,有原理圖嗎
作者: bg8sya    時(shí)間: 2016-3-30 23:48
樓主,我用這個(gè)控制TB6560驅(qū)動(dòng)42步進(jìn),但是不能反轉(zhuǎn),請(qǐng)指點(diǎn),其他正常,K2按鍵依然正轉(zhuǎn),TB6560采用的是共陰極接法




作者: bg7nr    時(shí)間: 2017-2-23 22:39
不錯(cuò),學(xué)習(xí)
作者: e介草民    時(shí)間: 2017-9-27 11:00
贊一個(gè)
作者: 謝戈里    時(shí)間: 2017-12-2 11:09

51hei有你更精彩!
作者: ymc1001    時(shí)間: 2018-6-6 20:27
這個(gè)用的是哪種電機(jī)




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