|
|
先上一波代碼，有問題 ，依然是看網(wǎng)上知道MG995 舵機(jī) 周期是20MS
占空比0.5ms是0° 2.5是180° 1.5ms是90° 但是舵機(jī)一直在都懂 現(xiàn)在有點(diǎn)懷疑是舵機(jī)有問題
有人能幫助解決下困難嗎
# include "reg52.h"
typedef unsigned int uint ;
typedef unsigned char uchar ;
sbit Stevo =P1^0;
uint djzz=15;
void time0init();
void main()
{
time0init();
djzz=25;
}
void time0init()
{
TMOD=0X01;
TH0=(65536-20)/256;
TL0=(65536-20)%256;
EA=1;
TR0=1;
ET0=1;
}
void time0 () interrupt 1
{
uint count =0; //占空比
TR0=0;
TH0=(65536-40)/256;
TL0=(65536-40)%256;
count++;
if(count >500) //40*500=2000=20ms 一個(gè)周期
{
count=0;
}
if( djzz<count ) // 所需要角度 的電壓固定 但是占空比給的電壓打 說明角度大 因此需要角度小一點(diǎn)
{
Stevo=0; // 給高轉(zhuǎn)
}
else
Stevo=1;
TR0=1;
}
|
|
