伺服舵机控制程序

最新推荐文章于 2024-07-05 16:28:42 发布

荆轩道

最新推荐文章于 2024-07-05 16:28:42 发布

阅读量1.1k

点赞数

分类专栏： KC机器人学习笔记

本文链接：https://blog.csdn.net/boj0102/article/details/8287095

版权

这是一个用C语言编写的KC伺服舵机控制程序，包括小车前进、停止、后退、绕中心左右转等功能。通过控制P1_0和P1_1引脚的高低电平变化，实现不同动作，并使用delay_nus和delay_nms进行延时控制。

摘要由CSDN通过智能技术生成

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