/***********************************************************
功能: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;co