標(biāo)題: 單路舵機(jī)控制單片機(jī)源程序 [打印本頁]
作者: 科院維修    時(shí)間: 2017-3-25 11:45
標(biāo)題: 單路舵機(jī)控制單片機(jī)源程序
單路舵機(jī) 帶調(diào)試成功



單片機(jī)源程序：
  1. #include "reg52.h"
  2. unsigned char count;      
  3. sbit pwm =P3^0;
  4. sbit jia =P1^4;           
  5. sbit jan =P1^5;           
  6. unsigned char jd;        
  7. void delay(unsigned char i)//延時(shí)
  8. {
  9.   unsigned char j,k;
  10.   for(j=i;j>0;j--)
  11.     for(k=125;k>0;k--);
  12. }
  13. void Time0_Init()           
  14. {
  15. TMOD = 0x01;           
  16. IE  = 0x82;
  17. TH0  = 0xfe;
  18. TL0  = 0xeb;     
  19.     TR0=1;                  
  20. }
  21. void Time0_Int() interrupt 1
  22. {
  23. TH0  = 0xfe;
  24. TL0  = 0xeb;

  26.     if(count<jd)              
  27.                 {pwm=1;
  28.                       pwm1=1; }
  29.     else
  30.                 { pwm=0;
  31.       pwm1=0;                 }
  32.     count=(count+1);  

  34.         }               
  35.    void keyscan()              
  36. {
  37.    if(jia==0)               
  38.   {
  39.     delay(10);              
  40.     if(jia==0)              
  41.      {
  42.                                       
  43.       jd++;                 
  44.       count=0;              
  45.       if(jd==6)
  46.           jd=5;               
  47.       while(jia==0);        
  48.      }
  49.   }
  50.   if(jan==0)               
  51.   {
  52.     delay(10);
  53.     if(jan==0)
  54.      {            
  55.       jd--;                 
  56.       count=0;
  57.       if(jd==0)
  58.         jd=1;              
  59.       while(jan==0);
  60.      }
  61.   }
  62. }
  63. void main()
  64. {
  65. jd=1;
  66. count=0;
  67.   pwm=0;
  68. Time0_Init();              
  69. while(1)
  70. {
  71.   keyscan();               
  72.   }
  73. }
復(fù)制代碼

下載：
舵機(jī)程序待修改.rar (29.06 KB, 下載次數(shù): 12)




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