PID相关的知识以及其c++实现

最新推荐文章于 2025-01-04 00:15:00 发布
最新推荐文章于 2025-01-04 00:15:00 发布
阅读量2k 收藏 17
点赞数 3
CC 4.0 BY-SA版权
分类专栏： px4
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.youkuaiyun.com/zouxu634866/article/details/79798477
本文详细介绍了PID控制器的不同类型，包括传统的位置式PID、增量式PID、积分分离PID及抗积分饱和PID，并提供了每种类型的实现代码。

摘要生成于 C知道 ，由 DeepSeek-R1 满血版支持， 前往体验 >

先感谢fc师兄的博客：https://blog.youkuaiyun.com/qq_28773183/article/details/79524766

前言：因为最近看的px4的源码中的控制部分就用的是PID，所以想自己打算用c++写一下pid，顺便复习一下。在师兄的博客中还学到了一些pid的改进型。

一、传统的PID（位置式PID）

这里写图片描述

输入的是我们的输入值（期望值），将与实际值做偏差后传给pid部分，然后传给作动器（比如电机什么的），然后再通过传感器将实际值表示出来在反馈回来。

初始时，反馈的信号为0，偏差量就是输入量。

离散化公式：u(k)=Kp*err(k)+Ki * ∑err(j) T+ Kd (err(k)−err(k−T))/T

注意：这里的∑err(j)不是前一次的err+此刻的err，而是从第一时刻的err一直累加到现在

程序实现：

#include <iostream>

using namespace std;


struct pid
{
    float pid_setspeed;      /****期望速度****/
    float pid_actualspeed;   /****实际速度****/
    float Kp;
    float Ki;
    float Kd;
    float err;               /**偏差**/
    float last_err;          /**上一次的偏差**/
    float voltage;           /**作动器输出的电压**/
    float T;                 /**更新周期**/
    float integral;
}_pid;



void pid_init();
float pid_run(float speed);



int main()
{
    int count;
    int n =1;

    cin >> count ;
    pid_init();

    while(n<count)
    {
        float output = pid_run(200.0);

        cout << n<<"."<<"输出的值为：" << " " << output << endl;
        n++;
    }


    return 0;
}


void pid_init()
{
    _pid.pid_setspeed = 0.0;
    _pid.pid_actualspeed = 0.0;
    _pid.Kd = 0.2;
    _pid.Kp = 0.2;
    _pid.Ki = 0.015;
    _pid.err = 0.0;
    _pid.last_err = 0.0;
    _pid.voltage = 0.0;
    _pid.T = 1.0 ;
    _pid.integral = 0.0;
}


float pid_run(float speed)
{
    _pid.pid_setspeed = speed;
    _pid.err = _pid.pid_setspeed - _pid.pid_actualspeed;
    _pid.integral = _pid.integral + _pid.err ;
    _pid.voltage = _pid.err*_pid.Kp + _pid.integral*_pid.T*_pid.Ki + (_pid.err-          _pid.last_err)*_pid.Kd;
    _pid.last_err = _pid.err;
    _pid.pid_actualspeed = _pid.voltage*1.0;


    return _pid.pid_actualspeed;

}

输出：
这里写图片描述

二、增量式PID

其实我通过查资料发现增量式pid本质上就是位置式PID。
直接写公式：Δu(k)=Kp*(err(k)−error(k−1))+ Ki err(k) T+Kd *(err(k)−2err(k−1)+err(k−2))/ T
所以通过公式求的是本时刻与上一时刻的pid输出的差。
因此传给作动器的输入是上一时刻的u（k），然后加上这里算的Δu(k)。

注意：有人会问这个u（k）怎么算，因为公式中并没有算呀，其实我们有一个初始状态时的u（k）=0，他加上Δu(k)不就是第一次的u（k），以后不断加不就得出来了吗？

程序（注意把逻辑理清楚）：

#include <iostream>

using namespace std;


struct pid
{
    float setspeed;      /****期望速度****/
    float actualspeed;   /****实际速度****/
    float Kp;
    float Ki;
    float Kd;
    float err;               /**偏差**/
    float last_err;          /**上一次的偏差**/
    float last_last_err;     /**上上一次的偏差**/
    float voltage;           /**作动器输出的电压**/
    float last_voltage;      /**上一时刻的电压**/
    float delta_voltage;     /**电压增量**/
    float T;                 /**更新周期**/
    float integral;
}_pid;



void pid_init();
float pid_run(float speed);
float pid_run2(float speed);



int main()
{
    int count;
    int n =1;

    cin >> count ;
    pid_init();


    //while(n<=2)
    //{
     //   float output = pid_run(200.0);

     //   cout << n<<"."<<"输出的值为：" << " " << output << endl;
     //   n++;



    //}

    while(n<count)
    {
        float output = pid_run2(200.0);
        cout << n<<"."<<"输出的值为：" << " " << output << endl;
        n++;

    }


    return 0;
}


void pid_init()
{
    _pid.setspeed = 0.0;
    _pid.actualspeed = 0.0;
    _pid.Kd = 0.2;
    _pid.Kp = 0.2;
    _pid.Ki = 0.015;
    _pid.err = 0.0;
    _pid.last_err = 0.0;
    _pid.voltage = 0.0;
    _pid.T = 1.0 ;
    _pid.integral = 0.0;
    _pid.last_voltage = 0.0;
    _pid.delta_voltage = 0.0;
    _pid.last_last_err = 0.0;
}


float pid_run(float speed)
{
    _pid.setspeed = speed;
    _pid.err = _pid.setspeed - _pid.actualspeed;
    _pid.integral = _pid.integral + _pid.err ;
    _pid.voltage = _pid.err*_pid.Kp + _pid.integral*_pid.T*_pid.Ki + (_pid.err-_pid.last_err)*_pid.Kd;

    _pid.last_last_err = _pid.last_err;
    _pid.last_err = _pid.err;
    _pid.last_voltage = _pid.voltage;
    _pid.actualspeed = _pid.voltage*1.0;

    return _pid.actualspeed;

}

float pid_run2(float speed)
{
    _pid.setspeed = speed;
    _pid.err = _pid.setspeed - _pid.actualspeed;
    _pid.delta_voltage = (_pid.err-2*_pid.last_err+_pid.last_last_err)*_pid.Kd + _pid.err*_pid.T*_pid.Ki + (_pid.err-_pid.last_err)*_pid.Kp;

    _pid.last_last_err = _pid.last_err;
    _pid.last_err = _pid.err;
    _pid.voltage = _pid.last_voltage + _pid.delta_voltage;
    _pid.last_voltage = _pid.voltage;
    _pid.actualspeed = _pid.voltage*1.0;

    return _pid.actualspeed；
}

程序中注释掉的部分就是我刚刚提的问题，我之前以为初始的u（k）应先通过位置式算，其实后来我把他删了也可以。

三、积分分离

在普通 PID 控制中,引入积分环节的目的,主要是为了消除静差,提高控制精度。但是在启动、结束或大幅度增减设定时,短时间内系统输出有很大的偏差,会造成 PID 运算的积分积累,导致控制量超过执行机构可能允许的最大动作范围对应极限控制量,从而引起较大的超调,甚至是震荡,这是绝对不允许的。为了克服这一问题,引入了积分分离的概念,其基本思路是 当被控量与设定值偏差较大时,取消积分作用; 当被控量接近给定值时,引入积分控制,以消除静差,提高精度。

代码：

#include <iostream>
#include <cmath>
using namespace std;


struct pid
{
    float pid_setspeed;      /****期望速度****/
    float pid_actualspeed;   /****实际速度****/
    float Kp;
    float Ki;
    float Kd;
    float err;               /**偏差**/
    float last_err;          /**上一次的偏差**/
    float voltage;           /**作动器输出的电压**/
    float T;                 /**更新周期**/
    float integral;
}_pid;



void pid_init();
float pid_run(float speed);



int main()
{
    int count;
    int n =1;

    cin >> count ;
    pid_init();

    while(n<count)
    {
        float output = pid_run(200.0);

        cout << n<<"."<<"输出的值为：" << " " << output << endl;
        n++;
    }


    return 0;
}


void pid_init()
{
    _pid.pid_setspeed = 0.0;
    _pid.pid_actualspeed = 0.0;
    _pid.Kd = 0.2;
    _pid.Kp = 0.2;
    _pid.Ki = 0.04;
    _pid.err = 0.0;
    _pid.last_err = 0.0;
    _pid.voltage = 0.0;
    _pid.T = 1.0 ;
    _pid.integral = 0.0;
}


float pid_run(float speed)
{
    _pid.pid_setspeed = speed;
    _pid.err = _pid.pid_setspeed - _pid.pid_actualspeed;

    if(abs(_pid.err)>180)
    {

    }
    else
    {
        _pid.integral = _pid.integral + _pid.err ;
    }



    _pid.voltage = _pid.err*_pid.Kp + _pid.integral*_pid.T*_pid.Ki + (_pid.err-_pid.last_err)*_pid.Kd;

    _pid.last_err = _pid.err;
    _pid.pid_actualspeed = _pid.voltage*1.0;



    return _pid.pid_actualspeed;

}

四、抗积分饱和

所谓的积分饱和现象是指如果系统存在一个方向的偏差,PID 控制器的输出由于积分作用的不断累加而加大,从而导致执行机构达到极限位置,若控制器输出 U(k)继续增大,执行器开度不可能再增大,此时计算机输出控制量超出了正常运行范围而进入饱和区。一旦系统出现反向偏差,u(k)逐渐从饱和区退出。进入饱和区越深则退出饱和区时间越长。在这段时间里,执行机构仍然停留在极限位置而不随偏差反向而立即做出相应的改变,这时系统就像失控一样,造成控制性能恶化,这种现象称为积分饱和现象或积分失控现象。防止积分饱和的方法之一就是抗积分饱和法,该方法的思路是在计算 u(k)时,首先判断上一时刻的控制量 u(k-1)是否已经超出了极限范围: 如果u(k−1)>umaxu(k−1)>umax则只累加负偏差; 如果 u(k−1)

C++实现PID控制算法
DplaAnaconda的博客
09-21 609
构造函数接受比例系数（Kp）、积分系数（Ki）和微分系数（Kd）作为参数，并初始化相应的成员变量。PID控制算法的基本原理是根据系统当前的误差（偏差）来调整控制器的输出，以使系统的输出接近目标值。根据实际需求，可以调整PID控制器的参数（比例系数、积分系数和微分系数），以获得更好的控制效果。其中，D为微分项的值，Kd为微分系数，d(error) / dt表示误差的导数。其中，I为积分项的值，Ki为积分系数，∫error dt表示误差的积分。其中，P为比例项的值，Kp为比例系数，error为当前误差。
C++实现PID控制算法（附完整源码）
希望我的博客，能帮上你解决学习中工作中所遇到的问题
05-23 861
C++实现PID控制算法（附完整源码）
C++实现PID算法
02-18
用C++语言实现PID控制算法
基于C++的PID控制器
热门推荐
Alexon Xu的博客
06-27 2万+
位置PID控制器 增量PID控制器 C++实现
基于C++的PID调节
09-16
绝大多数关于PID的调节都是基于C语言的，这个也是因为c语言在硬件方面的快捷所致，不否认C语言下的PID的方便，但是想要参考一下C++的PID基本调节可以参考本Demo
自适应模糊PID代码 C++实现
05-24
在C++中实现自适应模糊PID控制，通常涉及到以下几个关键知识点： 1. **PID控制器**：PID（比例-积分-微分）控制器是最常用的自动控制算法之一，通过调整比例（P）、积分（I）和微分（D）三个参数来控制系统的响应。...
模糊PID_C++项目源代码_可运行.rar
12-05
本项目源码提供了一种C++实现模糊PID的方法，适用于智能控制系统，并且经过测试，可确保其可运行性。本文将详细解析这一项目中的关键知识点。 1. **模糊逻辑**：模糊逻辑是一种处理不确定性和模糊性的数学工具，其...
PID控制C代码.rar_PID C#_PID c++_PID程序_pid c_pid.c
09-20
在这个"PID控制C代码.rar"压缩包中，包含了关于PID控制的基础知识以及C语言实现PID算法的程序。 PID控制的核心思想是通过三个部分的组合来调整系统的输出：比例（P）、积分（I）和微分（D）项。比例项直接反映了...
PID-CPP.rar_PID c++_pid cpp
09-22
标题中的"PID-CPP.rar"指的是一个关于PID控制器的C++实现的压缩文件，而"PID c++_pid cpp"进一步确认了这个压缩包包含的是用C++编写的PID控制器的代码示例。PID（比例-积分-微分）控制器是一种在自动化控制领域广泛...
C-for-PID.rar_PID C 算法_PID matlab _PID 算法_pid_pid c++ 语言
07-15
"pid_pid_c++_语言"标签暗示了C++实现的PID控制器可能涉及类的设计，封装比例、积分和微分组件，以及更新控制输出的方法。C++的面向对象特性使得代码结构更加清晰，易于维护和扩展。 在实际应用中，PID控制器的参数...
PID的C++编程
08-18
PID的用C++编程的代码，希望对大家有帮助
PID控制算法的C语言实现(完整版)
08-26
PID控制算法的C语言实现(完整版)
PID c++算法学习和实现
weixin_37781153的博客
07-17 1777
原理 原理图：
简易PID模块（C++）
weixin_43288132的博客
07-31 571
简易PID模块 源码为WR学长所写，现发布在优快云，作为传承，留给学弟使用。 库文件 #ifndef WR_CONTROLLER_H__ #define WR_CONTROLLER_H__ typedef struct { float P;//P参数 float I;//I参数 float D;//D参数 float integral;//积分值 float err;//期望值与当前值差值 float err_D;//负的当前值的微分 float integral_max
PID控制器及其C++实现
FC的博客
03-12 1万+
PID控制器原理 PID控制器实际上是对偏差的控制,其原理图如下: 其数学的表达如下: u(x)=Kp(err(t)+1T.∫err(t)dt+TDderr(t)dt)u(x)=Kp(err(t)+1T.∫err(t)dt+TDderr(t)dt)u(x)=K_p(err(t)+\frac{1}{T}.\int{err(t)dt}+\frac{T_Dderr(t)}{dt}) 其中:u...
C++进程PID编程
实践求真知
03-27 1815
一获取pid_t的字节长度 1代码 #include <iostream> using namespace std; int main(int argc, char *argv[]) { pid_t pid; cout <<"sizeof(pid_t)="<< sizeof(pid_t) << endl; ...
C++实现PID控制算法（附带源码）
最新发布
欢迎来到我的博客！这里是一个专注于计算机技术的分享平台，涵盖编程开发、算法研究、系统架构、软件工程等多个领域。无论你是初学者还是资深开发者，都能在这里找到有价值的内容。
01-04 1610
PID控制算法（比例-积分-微分控制，Proportional-Integral-Derivative）是一种常见的反馈控制算法，用于在各种自动化控制系统中实现稳定的控制。PID 控制器通过计算控制误差的三种成分：比例（P）、积分（I）、微分（D）来调节系统输出，从而使得系统的输出达到目标值。
C++实现自适应模糊PID控制代码解析
综上所述，提供的压缩包文件“自适应模糊PID代码 C++实现.zip”是一个包含了基于模糊逻辑的自适应PID控制算法的C++实现，其设计和应用需要对控制理论、模糊逻辑以及C++编程有深入的理解。该代码能够为学习和实现模糊...
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值