KC伺服舵机四个方向的打包程序

最新推荐文章于 2022-04-16 11:49:04 发布

原创

最新推荐文章于 2022-04-16 11:49:04 发布 · 777 阅读

0 ·

CC 4.0 BY-SA版权

这是一个针对KC伺服舵机的测试程序，用于实现设备的向前、向后、左转和右转四个方向的运动。通过指定脉冲宽度控制左右电机，以达到预期的运动效果。程序中定义了结构体来存储每个方向的脉冲宽度和计数，并通过for循环实现连续的电机脉冲控制，每完成一次运动后，会有一个短暂的延时。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

/***********************************************************
功能：KC伺服舵机测试程序
说明：P1_0接左电机，P1_1接右电机（四个方向的打包程序）
时间：2012.12.10
作者：荆轩道
************************************************************/

struct
{
char *dir;
int pulseLeft;
int pulseRight;
int counter;
}Forward={"Forward",1700,1300},
Backward={"Backward",1300,1700,65},
LeftTurn={"Turn Left",1300,1300,26},
RightTurn={"Turn Right",1700,1700,26};

void For_Ward(void)
{
   P1_1=1;
delay_nus(Forward.pulseLeft);
    P1_1=0;
P1_0=1;
delay_nus(Forward.pulseRight);
P1_0=0;
delay_nms(20);
}
void Left_Turn(void)
{
    int i;
    for(i=1;i<= LeftTurn.counter;i++)
{
  P1_1=1;
  delay_nus(LeftTurn.pulseLeft);
&