树莓派3b+ 舵机控制 C语言实现

要在树莓派3B+上控制舵机，你需要使用GPIO引脚和PWM模块。以下是一个简单的C语言程序示例，用于控制一个舵机的旋转角度：

#include <wiringPi.h>

#define SERVO_PIN 18 // GPIO18

int main(void)
{
    // 初始化wiringPi库
    if(wiringPiSetupGpio() == -1)
    {
        return 1;
    }

    // 设置GPIO18为PWM输出
    pinMode(SERVO_PIN, PWM_OUTPUT);

    // 设置PWM频率为50Hz
    pwmSetMode(PWM_MODE_MS);
    pwmSetRange(1024);
    pwmSetClock(375);

    // 控制舵机旋转到0度
    pwmWrite(SERVO_PIN, 75); // 0度对应的PWM输出值为75

    // 等待1秒
    delay(1000);

    // 控制舵机旋转到90度
    pwmWrite(SERVO_PIN, 125); // 90度对应的PWM输出值为125

    // 等待1秒
    delay(1000);

    // 控制舵机旋转到180度
    pwmWrite(SERVO_PIN, 175); // 180度对应的PWM输出值为175

    // 等待1秒
    delay(1000);

    // 关闭PWM输出
    pwmWrite(SERVO_PIN, 0);

    return 0;
}

这个程序使用GPIO18作为PWM输出口，设置PWM频率为50Hz，然后通过pwmWrite函数设置PWM输出值来控制舵机旋转角度。在这个示例程序中，0度对应的PWM输出值为75，90度对应的PWM输出值为125，180度对应的PWM输出值为175。你可以根据你的舵机规格来调整这些PWM输出值。