/***********************************************************
功能:KC伺服舵机测试程序
说明:P1_0接左电机,P1_1接右电机(四个方向的打包程序)
时间:2012.12.10
作者:荆轩道
************************************************************/
struct
{
char *dir;
int pulseLeft;
int pulseRight;
int counter;
}Forward={"Forward",1700,1300},
Backward={"Backward",1300,1700,65},
LeftTurn={"Turn Left",1300,1300,26},
RightTurn={"Turn Right",1700,1700,26};
void For_Ward(void)
{
P1_1=1;
delay_nus(Forward.pulseLeft);
P1_1=0;
P1_0=1;
delay_nus(Forward.pulseRight);
P1_0=0;
delay_nms(20);
}
void Left_Turn(void)
{
int i;
for(i=1;i<= LeftTurn.counter;i++)
{
P1_1=1;