伺服舵机控制程序

/***********************************************************
功能：KC伺服舵机测试程序
说明：P1_0接左电机，P1_1接右电机
时间：2012.12.12
作者：荆轩道
************************************************************/
#include<BoeBot.h>
#include<uart.h>

/*小车全速前进*/
void forward()
{
  P1_0=1;              //P1_0输出高电平 
  delay_nus(1700);       //延时1700ns
  P1_0=0;              //P1_0输出低电平               
  delay_nms(20);     //延时20ms

  P1_1=1;      //P1_1输出高电平
  delay_nus(1300);       //延时1500ns
  P1_1=0;     //P1_1输出低电平
  delay_nms(20);     //延时20ms
}  
/*小车停止*/
void stop()
{
  P1_0=0;              //P1_0输出高电平
  P1_1=0;      //P1_1输出高电平
  delay_nus(1500);       //延时1500ns
  P1_0=0;              //P1_0输出低电平
  P1_1=0;              //P1_1输出低电平
  delay_nms(20