怎用51單片機控制PowerHD數字舵機轉動，新人求程序

ID:205873 · 發表于 2017-5-29 16:33

最近買了一個PowerHD的LF-20MG數字舵機，之前只有控制MG995舵機的程序，但是用到數字舵機上卻不行了。有沒有大神幫忙解決的？必有重謝

以下是單片機控制MG995舵機的程序，怎么改成控制LF-20MG的程序呢？
#include<reg52.h>
#include<stdio.h>

#define uint unsigned int
#define uchar unsigned char
int i=0,k=0;
int a[8]={500,1000,1500,2000,2500,2000,1500,1000};

sbit P0_0=P0^0;
void Init_t0(void);

void main()
{
      P0_0=1;
      Init_t0();
      while(1);
}

void Init_t0(void)
{
      TMOD=0x01;
      TH0=(65536-500)/256;
      TL0=(65536-500)%256;
      EA=1;
      ET0=1;
      TR0=1;
}

void PWM0() interrupt 1
{
      if(P0_0==1)
      {

            TH0=(65536-(19950-a[k]))/256;
            TL0=(65536-(19950-a[k]))%256;
      }
      else
      {
            TH0=(65536-a[k])/256;
            TL0=(65536-a[k])%256;
      }
      P0_0=~P0_0;
i++;
if (i>=80)
      {
i=0;
k++;
if(k==8)k=0;
      }

}