找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 3884|回復(fù): 0
收起左側(cè)

51四個按鍵控制42/57步進(jìn)電機(jī)啟停正反，但速度一直加不上去

[復(fù)制鏈接]
ID:245224 發(fā)表于 2018-4-14 14:02 | 顯示全部樓層 |閱讀模式
80黑幣
代碼在下面，是我參考的網(wǎng)上代碼改寫的，但是步進(jìn)電機(jī)的速度一直很慢，提不上去，求大神能改下，讓步進(jìn)電機(jī)運(yùn)動快點(diǎn)，驅(qū)動器采用的是tb6600，脈沖加方向控制。
代碼：

  1. #include <reg52.h>
  2. sbit Clk = P2^0;
  3. sbit En = P2^1;        
  4. sbit Dir = P2^2;

  6. sbit CW = P2^4;                //正轉(zhuǎn)運(yùn)行按鍵
  7. sbit STOP = P2^5;        //停止運(yùn)行按鍵
  8. sbit CCW = P2^6;        //反轉(zhuǎn)運(yùn)行按鍵
  9. sbit ADJ = P2^7;        //調(diào)速運(yùn)行按鍵

  11. bit Run_Status;                //運(yùn)行狀態(tài)位標(biāo)志，
  12.                                         //=0表示電機(jī)在停止?fàn)顟B(tài)，可以按鍵正轉(zhuǎn)、反轉(zhuǎn)均可
  13.                                         //=1表示電機(jī)在運(yùn)行狀態(tài)，不支持正反轉(zhuǎn)按鍵，只有先停止。防止強(qiáng)行換向帶來的電流過大。

  15. unsigned char Run_Dir,t;        //電機(jī)運(yùn)行方向
  16. unsigned char timer1;

  18. #define        F_DIR        0                //正轉(zhuǎn)
  19. #define        R_DIR        1                //反轉(zhuǎn)

  21. unsigned int clock;         //周期變量

  23. void Delayms(unsigned int xms)         //延時函數(shù)
  24. {
  25.         unsigned int i,j;
  26.         for(i=xms;i>0;i--)
  27.             for(j=9;j>0;j--);
  28. }


  31. void Forward(void)          //電機(jī)正轉(zhuǎn)
  32. {
  33.         TH0=(65536-clock)/256;          //初值大小由clock值決定
  34.         TL0=(65536-clock)%256;          //clock增大，speed減��；clock減小，speed增大         
  35.         Dir=0;
  36.         En=1;
  37.         TR0=1;           //開定時器1中斷
  38. }

  40. void system_Ini()
  41. {
  42.     TMOD|= 0x11;
  43.     TH1 = 0xfe; //11.0592MHz 0.5ms定時
  44.     TL1 = 0x33;
  45.     TR1 = 1; //啟動T1定時
  46.     EA=1;
  47.         ET1=1; //開T0，T1中斷，開總中斷
  48. }                                 

  50. void Reversal(void)         //電機(jī)反轉(zhuǎn)
  51. {
  52.         TH0=(65536-clock)/256;         
  53.         TL0=(65536-clock)%256;         
  54.         Dir=1;
  55.         En=1;            
  56.         TR0=1;
  57. }

  59. char flag1 =0x00;
  60. bit flagstop=0;
  61. void Keyscan()
  62. {
  63.         if(STOP==0 && flagstop==0)                                //任何時候按停止鍵，電機(jī)停止運(yùn)行
  64.                 {        
  65.                         Delayms(1);                //延時去抖動
  66.                         if(STOP==0)                        
  67.                         {               
  68.                                 TR0=0;
  69.                                 Clk=0;
  70.                                                                 TR1=0;
  71.                                 En=0;
  72.                                 flag1=0;
  73.                             flagstop=1;
  74.                                 Run_Status=0;        //電機(jī)正在停止的狀態(tài)標(biāo)志
  75.                         }
  76.                 }
  77.             else if(!CW && !Run_Status && (flag1&0xf0)==0x00)        //按正轉(zhuǎn)鍵同時電機(jī)不是正在運(yùn)行時，電機(jī)正轉(zhuǎn)運(yùn)行
  78.                 {
  79.                         Delayms(1);                //按下延時去抖動
  80.                         if(!CW && !Run_Status)                        
  81.                         {        
  82.                            { flag1 =0x10;
  83.                                 Run_Status=1;
  84.                                                                 if(t<1)
  85.                                                         {
  86.                                                        
  87.                              Forward();
  88.                                                         }
  89.                             Run_Dir = F_DIR;        //電機(jī)運(yùn)行方向正轉(zhuǎn)                                
  90.                             flagstop=0;
  91.                                                            if(timer1>100)
  92.                                                         {
  93.                                                             timer1=0; //輸出占空比0.7的PWM脈沖
  94.                                                                 }
  95.                                                         if(timer1<30)
  96.                                                                 {
  97.                                                                     Clk=0;
  98.                                                                 }
  99.                                                         else
  100.                                                                 {
  101.                                                                     Clk=1;
  102.                                                                         }
  103.                                                         }
  104.                                                        
  105.                         }
  106.                 }
  107.               else if(!CCW && !Run_Status && (flag1&0x0f)==0)        //按反轉(zhuǎn)鍵同時電機(jī)不是正在運(yùn)行時，電機(jī)反轉(zhuǎn)運(yùn)行
  108.                 {
  109.                         Delayms(1);                //延時去抖動
  110.                         if(!CCW && !Run_Status)                        
  111.                         {        
  112.                                                                 if(t<1)
  113.                                                         {
  114.                                                        
  115.                                 Reversal();
  116.                                                         }
  117.                                 Run_Dir=R_DIR;        //電機(jī)運(yùn)行方向反轉(zhuǎn)
  118.                                 flagstop=0;
  119.                                                                 flag1 = 1;
  120.                                 Run_Status=1;        //電機(jī)正在運(yùn)行的狀態(tài)標(biāo)志

  122.                                                                 if(timer1>100)
  123.                                                         {
  124.                                                             timer1=0; //輸出占空比0.7的PWM脈沖
  125.                                                                 }
  126.                                                         if(timer1<50)
  127.                                                                 {
  128.                                                                     Clk=0;
  129.                                                                 }
  130.                                                         else
  131.                                                                 {
  132.                                                                     Clk=1;
  133.                                                                         }
  134.                                                         }
  135.                         }
  136.                
  137.                    if(!ADJ)
  138.                 {
  139.                         Delayms(1);                //延時去抖動
  140.                         if(!ADJ)
  141.                         {        
  142.                                 if(clock>201)        clock-=200;        
  143.                                 else                        clock=1000;
  144.                                 Run_Status=1;
  145.                                 TR0=1;
  146.                          }
  147.                 }
  148. }
  149. void Init(void)
  150. {
  151.         Run_Status=0;        //=0表示電機(jī)在停止?fàn)顟B(tài)，可以按鍵正轉(zhuǎn)、反轉(zhuǎn)均可
  152.         Clk = 0;
  153.         En = 0;
  154.         TH0=(65536-clock)/256;
  155.         TL0=(65536-clock)%256;
  156.         TMOD=0X01;
  157.         EA=1;
  158.         ET0=1;
  159.         TR0 =0;
  160. }


  163. void main(void)
  164. {
  165.                 t=0;
  166.                 timer1=0;
  167.         Init();
  168.                 system_Ini();
  169.         clock=500;
  170.         P1=0xff;
  171.         P3 =0XFF;
  172.         while(1)
  173.           {
  174.           Keyscan();        
  175.     }
  176. }


  179. void Timer0_ISR(void) interrupt 1
  180. {
  181.         TH0=(65536-clock)/256;
  182.         TL0=(65536-clock)%256;
  183.         Clk = ~Clk;     
  184.                 t++;   
  185. }
  186. /*************************************
  187. [ t1 (0.5ms)中斷] 中斷中做 PWM 輸出
  188. ------------1000/(0.02ms*250)=200Hz
  189. *************************************/
  190. void T1zd(void) interrupt 3 //3 為定時器1的中斷號 1 定時器0的中斷號 0 外部中斷1 2 外部中斷2 4 串口中斷
  191. {
  192. //        TH1 = 0xfe; //11.0592MHz 0.5ms定時
  193. //        TL1 = 0x33;
  194.     TH0=(65536-200)/256;
  195.     TL0=(65536-200)%256;
  196.     timer1++; //計(jì)數(shù)+1
  197. }
復(fù)制代碼
我想的是先低速啟動，然后再加速運(yùn)行，如果能夠直接快速啟動也行。


回復(fù)

使用道具 舉報(bào)

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

本版積分規(guī)則

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

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

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