用C语言写一个sg90的控制函数
时间: 2023-02-16 16:42:50 浏览: 169
你好!下面是用 C 语言写的 SG90 控制函数的示例:
```
#include <stdio.h>
#include <wiringPi.h>
#define SG90_PIN 1 // SG90 接在树莓派的第 1 个 GPIO 引脚上
void sg90_control(int degree)
{
int pulse_width = 500 + (degree + 90) * 2000 / 180; // 计算脉冲宽度
digitalWrite(SG90_PIN, HIGH); // 将引脚设为高电平
delayMicroseconds(pulse_width); // 延时脉冲宽度的时间
digitalWrite(SG90_PIN, LOW); // 将引脚设为低电平
delay(20); // 延时 20 毫秒,等待 SG90 旋转到指定位置
}
int main()
{
wiringPiSetup(); // 初始化 wiringPi
pinMode(SG90_PIN, OUTPUT); // 将引脚设为输出模式
sg90_control(-45); // 将 SG90 旋转到 -45 度
sg90_control(45); // 将 SG90 旋转到 45 度
return 0;
}
```
在运行这段代码之前,需要先安装 wiringPi 库。可以使用下面的命令进行安装:
```
sudo apt-get install wiringpi
```
在编译这段代码时,需要使用下面的命令:
```
gcc sg90.c -o sg90 -lwiringPi
```
运行编译生成的可执行文件 sg90 即可控制 SG90。
阅读全文