標(biāo)題: 51單片機(jī)控制MG99R舵機(jī)源碼 [打印本頁]
作者: 唱歌睡覺打豆豆    時間: 2019-3-11 12:41
標(biāo)題: 51單片機(jī)控制MG99R舵機(jī)源碼
使用舵機(jī)型號為MG99R

產(chǎn)品參數(shù)：

速度: 4.8v 0.20sec/60°           6.0V 0.19sec/60°

扭力：4.8V 13KG-cm               6.0V  15KG-cm

電壓 4.8V-7.2V

空載工作電流：120Ma             堵轉(zhuǎn)工作電流：1450mA

響應(yīng)脈寬時間=<5usec

上升沿時間對應(yīng)角度：

0.5ms           0 度

1ms           45度

1.5ms           90度

2.0ms           135度

2.5ms           180度

驅(qū)動舵機(jī)需要一個20ms的時基脈沖，高電平在0.5-2.5ms內(nèi)

舵機(jī)有三根線：黃色為信號線，紅色為電源線，棕色為地線。

單片機(jī)源程序:
  1. #include <reg51.h>
  2. unsigned int target=6,percent=0;//將最初的高電平時間設(shè)為0.6ms
  3. sbit pwm=P0^0;//P0^0口輸出脈沖信號
  4. sbit key1=P3^0;
  5. sbit key2=P3^1;
  6. //函數(shù)說明
  7. void Timer0initial();
  8. void initial_Timer();
  9. void delay(unsigned int x);
  10. void keyscan();

  12. void delay(unsigned int x)//延時
  13. {
  14.         unsigned int i,j;
  15.         for(i=0;i<x;++i)
  16.         for(j=120;j>0;--j);
  17. }
  18. void keyscan()
  19. {
  20.         if(key1==0)
  21.         {
  22.                 delay(3);
  23.                 if(key1==0)
  24.                 {
  25.                         if(target>=7)
  26.                         {
  27.                                 target-=1;
  28.                         }
  29.                         while(key1==0)
  30.                         {P1=0x00;}//避免長按一直轉(zhuǎn)動
  31.                 }
  32.                 P1=0xff;
  33.         }
  34.         if(key2==0)//剛啟動只能按按鍵2
  35.         {
  36.                 delay(3);
  37.                 if(key2==0)
  38.                 {
  39.                         if(target<=25)
  40.                         {
  41.                                 target+=5;//可以調(diào)節(jié)舵機(jī)每次轉(zhuǎn)過的角度
  42.                         }
  43.                         while(key2==0)
  44.                         {P1=0x00;}
  45.                 }
  46.                 P1=0xff;
  47.         }
  48. }
  49. void initial()
  50. {
  51.         key1=1;
  52.         key2=1;
  53.         P1=0xff;//設(shè)置P1初值
  54.         initial_Timer();
  55. }
  56. void Timer0initial()
  57. {
  58.         TH0=(65536-65)/256;
  59.         TL0=(65536-65)%256;
  60. }//每0.1ms產(chǎn)生一次中斷（實測）
  61. void initial_Timer()
  62. {
  63.         EA=1;//開啟總中斷
  64.         ET0=1;//允許T0中斷
  65.         TMOD=0x01;//使用工作方式1
  66.         Timer0initial();
  67.         TR0=1;//軟件中斷允許
  68. }

  70. void Timer0() interrupt 1 using 0//中斷方式為定時器/計數(shù)器0內(nèi)部中斷
  71. {
  72.         percent+=1;
  73.         if(percent==200)
  74.         {
  75.                 percent=0;
  76.                 pwm=1;//高電平輸出
  77.         }
  78.         if(percent==target)
  79.         {
  80.                 pwm=0;
  81.         }
  82.         Timer0initial();
  83. }
  84. void main()
  85. {
  86.         initial();
  87.         while(1)
  88.         {
  89.                 keyscan();
  90.         }
  91. }
復(fù)制代碼






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