|
|
最近買了一個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;
}
}
|
|
非常感謝了！
