用c语言写个舵机pid控制代码

好的，我可以回答这个问题。以下是一个简单的舵机PID控制代码示例：

#include <stdio.h>
#include <stdlib.h>
#include <math.h>

#define KP 1.
#define KI .1
#define KD .01

double error = .;
double last_error = .;
double integral = .;
double derivative = .;

double pid_control(double setpoint, double input)
{
    error = setpoint - input;
    integral += error;
    derivative = error - last_error;
    last_error = error;

    double output = KP * error + KI * integral + KD * derivative;
    return output;
}

int main()
{
    double setpoint = 90.;
    double input = .;
    double output = .;

    while (1) {
        // 获取输入值
        printf("请输入当前舵机角度：");
        scanf("%lf", &input);

        // 计算输出值
        output = pid_control(setpoint, input);

        // 输出控制信号
        printf("控制信号：%lf\n", output);
    }

    return ;
}

这个代码示例中，我们使用了PID控制算法来控制舵机的角度。其中，KP、KI、KD分别代表比例、积分、微分系数，可以根据实际情况进行调整。在主函数中，我们通过不断获取当前舵机角度，并计算出相应的控制信号来实现PID控制。