|
我的showmsg("rcservo_Initialize success.\n")有印出來,但是馬達都沒有動~~~~
int main(int argc, char* argv[])
{
unsigned long usedchannels = 0x00ffff80L; //default to use channels 7~23
if(rcservo_Initialize(usedchannels))
{
showmsg("rcservo_Initialize success.\n");
unsigned long PWM_period = 20000L; //20000us
unsigned long PWM_duty_middle = 1500L; // PWM 1.5 ms 置中
unsigned long PWM_duty_left = 800L; // PWM 0.8 ms 置中
unsigned long PWM_duty_right = 2200L; // PWM 2.2 ms 置中
unsigned long count = 100;
rcservo_EnterPWMMode();
while(true)
{
rcservo_SendPWMPulses(usedchannels, PWM_period, PWM_duty_left,1);
showmsg("playing PWM_duty_left .\n");
while (!rcservo_IsPWMCompleted(usedchannels));
showmsg("finishing PWM_duty_left .\n");
Sleep(2000);
rcservo_SendPWMPulses(usedchannels, PWM_period, PWM_duty_middle,1);
showmsg("playing PWM_duty_middle .\n");
while (!rcservo_IsPWMCompleted(usedchannels));
showmsg("finishing PWM_duty_middle .\n");
Sleep(2000);
rcservo_SendPWMPulses(usedchannels, PWM_period, PWM_duty_right,1);
showmsg("playing PWM_duty_right .\n");
while (!rcservo_IsPWMCompleted(usedchannels));
showmsg("finishing PWM_duty_right .\n");
Sleep(2000);
}
}
rcservo_Close();
} |
|