【C语言实现PID控制器】

2024-06-13 16:12
文章标签 语言 实现 控制器 pid

本文主要是介绍【C语言实现PID控制器】,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

PID 控制器

PID(比例-积分-微分)控制器的公式用于计算控制信号,基于当前误差、误差的积分以及误差的微分。PID控制器的标准公式如下:

u ( t ) = K p e ( t ) + K i ∫ 0 t e ( τ ) d τ + K d d e ( t ) d t u(t) = K_pe(t) + K_i\int_0^te(\tau)d\tau+K_d\frac{de(t)}{dt} u(t)=Kpe(t)+Ki0te(τ)dτ+Kddtde(t)
其中:

  • u ( t ) u(t) u(t) 是控制信号。
  • e ( t ) e(t) e(t) 是当前误差,即设定点(目标值)与实际值(测量值)之间的差。
  • K p K_p Kp 是比例增益。
  • K i K_i Ki 是积分增益。
  • K d K_d Kd 是微分增益。

离散形式下,PID控制器的公式可以表示为:
u [ n ] = K p e [ n ] + K i ∑ i = 0 n e [ i ] Δ t + K d e [ n ] − e [ n − 1 ] Δ t u[n] = K_pe[n] + K_i \sum_{i=0}^ne[i] \Delta t +K_d \frac{e[n]-e[n-1]}{ \Delta t} u[n]=Kpe[n]+Kii=0ne[i]Δt+KdΔte[n]e[n1]
其中:

  • u [ n ] u[n] u[n] 是第 n n n 个采样时刻的控制信号。
  • e [ n ] e[n] e[n] 是第 n n n 个采样时刻的误差。
  • Δ t \Delta t Δt 是采样周期。

PID控制器的C语言实现

根据上述公式,可以用C语言实现一个离散PID控制器。以下是实现过程:

变量定义和初始化

#include <stdio.h>// PID控制器参数
float Kp = 1.0; // 比例增益
float Ki = 0.1; // 积分增益
float Kd = 0.05; // 微分增益// PID控制器状态
float integral = 0.0; // 误差的积分
float previous_error = 0.0; // 上一次的误差

PID 控制器函数

实现一个函数来计算控制信号:

float PID_Controller(float setpoint, float measured_value, float dt) {// 计算误差float error = setpoint - measured_value;// 计算误差的积分integral += error * dt;// 计算误差的微分float derivative = (error - previous_error) / dt;// 计算控制信号float control_signal = Kp * error + Ki * integral + Kd * derivative;// 更新上一次的误差previous_error = error;return control_signal;
}

主循环

在循环中使用PID控制器函数来更新控制信号:

int main() {float setpoint = 1.0; // 目标设定点float measured_value = 0.0; // 测量的过程变量float control_signal = 0.0; // 控制信号float dt = 0.1; // 时间步长(秒)// 模拟循环for (int i = 0; i < 100; i++) {// 模拟过程(这是一个示例,需要替换为你的过程模型)measured_value += control_signal * dt;// 使用 PID 控制器计算控制信号control_signal = PID_Controller(setpoint, measured_value, dt);// 打印结果printf("时间: %.2f, 设定点: %.2f, 测量值: %.2f, 控制信号: %.2f\n", i * dt, setpoint, measured_value, control_signal);}return 0;
}

考虑事项:

  • 参数调节:需要针对具体系统调节 K p K_p Kp K i K_i Ki K d K_d Kd 增益以获得期望的性能。
  • 积分饱和:实际应用中,可能需要添加逻辑防止积分项过大(积分饱和)。

这是一个基础的PID控制器示例,可以根据需要添加更多功能,如积分抗饱和机制、更高级的数值积分方法等。

动态调整 PID 控制器的参数( K p K_p Kp K i K_i Ki K d K_d Kd

示例1

这种方法被称为自适应控制或增量控制。以下是一个示例,展示了如何根据测量结果动态调整 PID 控制器的增益。

#include <stdio.h>// PID 控制器参数
float Kp = 1.0; // 初始比例增益
float Ki = 0.1; // 初始积分增益
float Kd = 0.05; // 初始微分增益// PID 控制器状态
float integral = 0.0; // 误差的积分
float previous_error = 0.0; // 上一次的误差// 更新 PID 参数的函数
void Update_PID_Gains(float error) {// 这里是一个简单的示例,可以根据误差调整增益if (error > 0.5) {Kp += 0.1;Ki += 0.01;Kd += 0.005;} else if (error < -0.5) {Kp -= 0.1;Ki -= 0.01;Kd -= 0.005;}// 防止增益变为负值if (Kp < 0) Kp = 0;if (Ki < 0) Ki = 0;if (Kd < 0) Kd = 0;
}// PID 控制器函数
float PID_Controller(float setpoint, float measured_value, float dt) {// 计算误差float error = setpoint - measured_value;// 计算误差的积分integral += error * dt;// 计算误差的微分float derivative = (error - previous_error) / dt;// 计算控制信号float control_signal = Kp * error + Ki * integral + Kd * derivative;// 更新上一次的误差previous_error = error;// 更新 PID 增益Update_PID_Gains(error);return control_signal;
}int main() {float setpoint = 1.0; // 目标设定点float measured_value = 0.0; // 测量的过程变量float control_signal = 0.0; // 控制信号float dt = 0.1; // 时间步长(秒)// 模拟循环for (int i = 0; i < 100; i++) {// 模拟过程(这是一个示例,需要替换为你的过程模型)measured_value += control_signal * dt;// 使用 PID 控制器计算控制信号control_signal = PID_Controller(setpoint, measured_value, dt);// 打印结果printf("时间: %.2f, 设定点: %.2f, 测量值: %.2f, 控制信号: %.2f, Kp: %.2f, Ki: %.2f, Kd: %.2f\n", i * dt, setpoint, measured_value, control_signal, Kp, Ki, Kd);}return 0;
}

示例2

#include <stdio.h>  // PID结构体和函数声明  
// ... (与上面的示例相同)  // 假设的性能评估函数  
// 在实际应用中,这通常基于系统的实际性能  
double evaluate_performance(double output, double setpoint) {  // 返回一个评估值,例如基于误差的绝对值或其他指标  double error = setpoint - output;  return fabs(error); // 绝对误差作为示例  
}  // 根据规则调整PID参数  
void adjust_pid_parameters(PID* pid, double input, double output, double setpoint) {  double error = setpoint - output;  double derivative = error - pid->previous_error; // 假设dt为1  // 评估当前性能  double performance = evaluate_performance(output, setpoint);  // 假设的调整规则(根据实际需求调整)  if (performance > 10.0) { // 假设的性能阈值  // 如果性能不佳,增加Kp  pid->kp *= 1.1;  // 也可以考虑减少Ki和Kd,以避免积分饱和和微分噪声  // pid->ki *= 0.9;  // pid->kd *= 0.9;  } else if (pid->integral > 100.0) { // 假设的积分阈值  // 如果积分项过大,减少Ki  pid->ki *= 0.9;  }  // 可以添加更多规则来调整Kd等  // 更新误差以供下一次使用  pid->previous_error = error;  
}  int main() {  PID pid;  PID_Init(&pid, 100.0, 1.0, 0.1, 0.01); // 初始化PID  double input = 0.0; // 假设的当前输入值  double output;  // 示例:模拟PID控制过程(假设输入值在某个过程中变化)  for (int i = 0; i < 100; i++) {  // 假设输入值在某个过程中逐渐接近设定点  input = i;  // 计算PID输出  output = PID_Compute(&pid, input);  // 在这里,你可以将output应用于系统,例如控制电机的速度或位置  // 评估当前性能并调整PID参数  adjust_pid_parameters(&pid, input, output, pid.setpoint);  // 打印调试信息  printf("Input: %f, Output: %f, Setpoint: %f, Error: %f\n", input, output, pid.setpoint, pid.setpoint - output);  }  return 0;  
}

示例3

#include <stdio.h>
#include <math.h>typedef struct {double Kp;    // 比例增益double Ki;    // 积分增益double Kd;    // 微分增益double setPoint; // 设定值double output; // 控制器输出double lastError; // 上一次的误差double integral; // 误差积分
} PIDController;void PID_Init(PIDController *pid, double Kp, double Ki, double Kd, double setPoint) {pid->Kp = Kp;pid->Ki = Ki;pid->Kd = Kd;pid->setPoint = setPoint;pid->output = 0.0;pid->lastError = 0.0;pid->integral = 0.0;
}void PID_Update(PIDController *pid, double measuredValue, double dt) {double error = pid->setPoint - measuredValue;pid->integral += error * dt;double derivative = (error - pid->lastError) / dt;pid->output = pid->Kp * error + pid->Ki * pid->integral + pid->Kd * derivative;pid->lastError = error;
}// 简单的自适应规则,根据误差调整Kp, Ki, Kd
void Adapt_PID(PIDController *pid, double error, double dt) {// 这里只是一个示例,实际的自适应规则可能更复杂if (fabs(error) > 1.0) {pid->Kp *= 1.1; // 如果误差较大,增加Kppid->Ki *= 1.1; // 增加Kipid->Kd *= 0.9; // 减少Kd} else {pid->Kp *= 0.9; // 如果误差较小,减少Kppid->Ki *= 0.9; // 减少Kipid->Kd *= 1.1; // 增加Kd}
}int main() {PIDController pid;PID_Init(&pid, 1.0, 0.1, 0.05, 100.0);double measuredValue = 0.0;double dt = 0.01;for (int i = 0; i < 1000; i++) {measuredValue = 100.0 * sin(0.1 * i * dt);PID_Update(&pid, measuredValue, dt);Adapt_PID(&pid, pid.setPoint - measuredValue, dt); // 根据误差自适应调整参数printf("Measured Value: %f, PID Output: %f, Kp: %f, Ki: %f, Kd: %f\n",measuredValue, pid.output, pid.Kp, pid.Ki, pid.Kd);}return 0;
}

这篇关于【C语言实现PID控制器】的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/1057788

相关文章

深入理解Go语言中二维切片的使用

《深入理解Go语言中二维切片的使用》本文深入讲解了Go语言中二维切片的概念与应用,用于表示矩阵、表格等二维数据结构,文中通过示例代码介绍的非常详细,需要的朋友们下面随着小编来一起学习学习吧... 目录引言二维切片的基本概念定义创建二维切片二维切片的操作访问元素修改元素遍历二维切片二维切片的动态调整追加行动态

Linux下删除乱码文件和目录的实现方式

《Linux下删除乱码文件和目录的实现方式》:本文主要介绍Linux下删除乱码文件和目录的实现方式,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录linux下删除乱码文件和目录方法1方法2总结Linux下删除乱码文件和目录方法1使用ls -i命令找到文件或目录

SpringBoot+EasyExcel实现自定义复杂样式导入导出

《SpringBoot+EasyExcel实现自定义复杂样式导入导出》这篇文章主要为大家详细介绍了SpringBoot如何结果EasyExcel实现自定义复杂样式导入导出功能,文中的示例代码讲解详细,... 目录安装处理自定义导出复杂场景1、列不固定,动态列2、动态下拉3、自定义锁定行/列,添加密码4、合并

mybatis执行insert返回id实现详解

《mybatis执行insert返回id实现详解》MyBatis插入操作默认返回受影响行数,需通过useGeneratedKeys+keyProperty或selectKey获取主键ID,确保主键为自... 目录 两种方式获取自增 ID:1. ​​useGeneratedKeys+keyProperty(推

Spring Boot集成Druid实现数据源管理与监控的详细步骤

《SpringBoot集成Druid实现数据源管理与监控的详细步骤》本文介绍如何在SpringBoot项目中集成Druid数据库连接池,包括环境搭建、Maven依赖配置、SpringBoot配置文件... 目录1. 引言1.1 环境准备1.2 Druid介绍2. 配置Druid连接池3. 查看Druid监控

Linux在线解压jar包的实现方式

《Linux在线解压jar包的实现方式》:本文主要介绍Linux在线解压jar包的实现方式,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录linux在线解压jar包解压 jar包的步骤总结Linux在线解压jar包在 Centos 中解压 jar 包可以使用 u

c++ 类成员变量默认初始值的实现

《c++类成员变量默认初始值的实现》本文主要介绍了c++类成员变量默认初始值,文中通过示例代码介绍的非常详细,对大家的学习或者工作具有一定的参考学习价值,需要的朋友们下面随着小编来一起学习学习吧... 目录C++类成员变量初始化c++类的变量的初始化在C++中,如果使用类成员变量时未给定其初始值,那么它将被

Qt使用QSqlDatabase连接MySQL实现增删改查功能

《Qt使用QSqlDatabase连接MySQL实现增删改查功能》这篇文章主要为大家详细介绍了Qt如何使用QSqlDatabase连接MySQL实现增删改查功能,文中的示例代码讲解详细,感兴趣的小伙伴... 目录一、创建数据表二、连接mysql数据库三、封装成一个完整的轻量级 ORM 风格类3.1 表结构

基于Python实现一个图片拆分工具

《基于Python实现一个图片拆分工具》这篇文章主要为大家详细介绍了如何基于Python实现一个图片拆分工具,可以根据需要的行数和列数进行拆分,感兴趣的小伙伴可以跟随小编一起学习一下... 简单介绍先自己选择输入的图片,默认是输出到项目文件夹中,可以自己选择其他的文件夹,选择需要拆分的行数和列数,可以通过

一文详解SpringBoot中控制器的动态注册与卸载

《一文详解SpringBoot中控制器的动态注册与卸载》在项目开发中,通过动态注册和卸载控制器功能,可以根据业务场景和项目需要实现功能的动态增加、删除,提高系统的灵活性和可扩展性,下面我们就来看看Sp... 目录项目结构1. 创建 Spring Boot 启动类2. 创建一个测试控制器3. 创建动态控制器注