用c语言写一个位置式pid控制函数

好的，下面是一个简单的位置式PID控制函数的C语言实现：

#include <stdio.h>

// 定义PID参数
double Kp = 0.5;
double Ki = 0.2;
double Kd = 0.1;

// 定义全局变量
double error_sum = 0;
double last_error = 0;

// 定义控制函数
double pid_control(double setpoint, double feedback, double dt)
{
    // 计算偏差
    double error = setpoint - feedback;

    // 计算误差累积和
    error_sum += error * dt;

    // 计算误差变化率
    double error_rate = (error - last_error) / dt;
    last_error = error;

    // 计算PID输出
    double output = Kp * error + Ki * error_sum + Kd * error_rate;

    return output;
}

int main()
{
    double setpoint = 50;   // 设定值
    double feedback = 0;    // 反馈值
    double dt = 0.1;        // 控制周期

    for(int i=0; i<100; i++)
    {
        double output = pid_control(setpoint, feedback, dt);
        printf("output: %f\n", output);

        feedback += output * dt;   // 模拟反馈值的变化
    }

    return 0;
}

在上述代码中，我们定义了三个PID参数（Kp、Ki、Kd），以及两个全局变量（error_sum、last_error）用于计算误差的累积和和变化率。然后，我们实现了一个pid_control函数，其中输入变量包括设定值(setpoint)、反馈值(feedback)和控制周期(dt)，输出变量为PID控制器的输出值(output)。

在主函数中，我们模拟了100个控制周期，每个周期中计算一次PID输出，并更新反馈值，最终输出PID控制器的输出值。