伺服舵机四方运动程序以及角度确定

/***********************************************************

功能：KC伺服舵机四方运动程序以及角度确定

说明：P1_0接左电机，P1_1接右电机

时间：2012.12.10

作者：荆轩道

************************************************************/

#include<BoeBot.h>

#include<uart.h>

int main(void)

{

int counter;

uart_Init();

printf("Program Running!\n");

for(counter=1;counter<=65;counter++)//向前

{

P1_1=1;

delay_nus(1700);

P1_1=0;

P1_0=1;

delay_nus(1300);

P1_0=0;

delay_nms(20);

}

for(counter=1;counter<=26;counter++)//向左转1/4圈 90度

{

P1_1=1;

delay_nus(1300);

P1_1=0;

P1_0=1;

delay_nus(1300);

P1_0=0;

delay_nms(20);

}

for(counter=1;counter<=26;counter++)//向右转1/4圈

{

P1_1=1;

delay_nus(1700);

P1_1=0;

P1_0=1;

delay_nus(1700);

P1_0=0;

delay_nms(20);

}

for(counter=1;counter<=65;counter++)//向后退

{

P1_1=1;

delay_nus(1300);

P1_1=0;

P1_0=1;

delay_nus(1700);

P1_0=0;

delay_nms(20);

}

while(1);

}