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

/***********************************************************
功能：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);   
}