KC伺服舵机带参控制程序程序

来源：互联网发布：sql查找最后一条记录编辑：程序博客网时间：2024/04/29 12:31

/***********************************************************
功能：KC伺服舵机带参控制程序程序
说明：P1_0接左电机，P1_1接右电机，
PulseDuration的取值为1300～1700，用来控制方向
PulseNumber用来控制运行时间如：（65，1300）
时间：2012.12.10
作者：荆轩道
************************************************************/
#include<BoeBot.h>
#include<uart.h>

int main(void)
{
int Counter;
int PulseNumber,PulseDuration;
uart_Init();
printf("Program Running!\n");

printf("Please input pulse number:\n");
scanf("%d",&PulseNumber);
printf("Please input pulse duration:\n");
scanf("%d",&PulseDuration);

for(Counter=1;Counter<=PulseNumber;Counter++)
{
     P1_1=1;
  delay_nus(PulseDuration);
  P1_1=0;
  delay_nms(20);
}
for(Counter=1;Counter<=PulseNumber;Counter++)
{
      P1_0=1;
   delay_nus(PulseDuration);
   P1_0=0;
  delay_nms(20);
}
while(1);
}