手撕PID（带死区、积分分离、不完全微分）

最新推荐文章于 2024-02-28 19:34:35 发布
最新推荐文章于 2024-02-28 19:34:35 发布
阅读量5.8k 收藏 80
点赞数 11
文章标签： 算法 c++
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/qq_45601625/article/details/119838934
版权

手撕PID（带死区、积分分离、不完全微分）

一、位置式PID

ΔU(k)=kp*(err(k)-err(k-1))+kie(k)+kd(e(k)-2*e(k-1)+e(k-2))
U(k)=U(k-1)+ΔU(k)

二、积分分离

在过程的启动、结束或大幅度增减设定值时，短时间内系统输出有很大偏差，会造成PID运算的积分累积，引起超调或者振荡。为了解决这一干扰，人们引入了积分分离的思想。其思路是偏差值较大时，取消积分作用，以免于超调量增大；而偏差值较小时，引入积分作用，以便消除静差，提高控制精度。

具体的实现步骤是：根据实际情况，设定一个阈值；当偏差大于阈值时，消除积分仅用PD控制；当偏差小于等于阈值时，引入积分采用PID控制。则控制算法可表示为：
在这里插入图片描述在这里插入图片描述

三、不完全微分PID

微分项有引入高频干扰的风险，但若在控制算法中加入低通滤波器，则可使系统性能得到改善。方法之一就是在PID算法中加入一个一阶低通滤波器。这就是所谓的不完全微分，其结构图如下：

在这里插入图片描述
微分部分表达式为：
在这里插入图片描述
其中 其中α的取值在0和1之间，有滤波常数和采样周期确定

四、带死区的PID

带死区的PID控制算法就是检测偏差值，若是偏差值达到一定程度，就进行调节。若是偏差值较小，就认为没有偏差。用公式表示如下：
在这里插入图片描述
其中的死区值得选择需要根据具体对象认真考虑，因为该值太小就起不到作用，该值选取过大则可能造成大滞后。

带死区的PID算法，对无论位置型还是增量型的表达式没有影响，不过它是一个非线性系统。

除以上描述之外还有一个问题，在零点附近时，若偏差很小，进入死去后，偏差置0会造成积分消失，如是系统存在静差将不能消除，所以需要人为处理这一点。

c++程序实现

#头文件

#ifndef PID_H
#define PID_H
typedef struct
{
    float kp;
    float ki;
    float kd;
    float ek;//当前误差
    float ekk;//上一次误差
    float ekkk; //上两次误差
    float alpha;//不完全微分系数
    float lastDev;//上一次微分环节的增量
    float separationThreshold;//积分分离阈值，误差大于阈值时PD，误差小于阈值时PID
    float ekDeadZone;//PID死区
    float increment; //PID增量
    float lastOutputValue;//上一次PID输出值
    float upLimit;//输出上限
    float lowLimit;//输出下限
}PidParameter;

class PID{
public:

    //增量式PID
    int IncrementalPID(float exceptionValue,float feedbackValue,float outputValue);
    //积分分离式PID，防止超调
    int integrationSeparationPID(float exceptionValue,float feedbackValue,float outputValue);
    //不完全微分PID，微分环节加低通滤波，抑振高频噪声
    int incompleteDifferentialPID(float exceptionValue,float feedbackValue,float outputValue);
    //带死区的PID，偏差限定最小值，小于最小值则为0，防止系统稳定点频繁调节
    int deadZonePID(float exceptionValue,float feedbackValue,float outputValue);
    //带积分分离、死区的不完全微分的增量式PID
    int fullPID(float exceptionValue,float feedbackValue,float outputValue);
private:
    PidParameter pidParam;
};
#endif // PID_H

#源文件

#include "PID.h"
#include "math.h"
int PID::IncrementalPID(float exceptionValue,float feedbackValue,float outputValue)
{

    pidParam.kp=10;
    pidParam.ki=10;
    pidParam.kd=10;

    pidParam.ek=exceptionValue-feedbackValue;
    pidParam.increment = pidParam.kp*(pidParam.ek-pidParam.ekk)+pidParam.ki*pidParam.ek+pidParam.kd*(pidParam.ek-2*pidParam.ekk+pidParam.ekkk);
    pidParam.ekkk=pidParam.ekk;
    pidParam.ekk=pidParam.ek;
    outputValue = outputValue+pidParam.increment;
    return 0;
}

int  PID::integrationSeparationPID(float exceptionValue,float feedbackValue,float outputValue)
{

    pidParam.kp=10;
    pidParam.ki=10;
    pidParam.kd=10;
    pidParam.separationThreshold=5;
    pidParam.ek=exceptionValue-feedbackValue;
    if(pidParam.ek<pidParam.separationThreshold)//小于阈值则PID
    {
        pidParam.increment = pidParam.kp*(pidParam.ek-pidParam.ekk)+pidParam.ki*pidParam.ek+pidParam.kd*(pidParam.ek-2*pidParam.ekk+pidParam.ekkk);
    }
    else {
        pidParam.increment = pidParam.kp*(pidParam.ek-pidParam.ekk)+pidParam.kd*(pidParam.ek-2*pidParam.ekk+pidParam.ekkk);
    }
    pidParam.ekkk=pidParam.ekk;
    pidParam.ekk=pidParam.ek;
    outputValue = outputValue+pidParam.increment;
    return 0;
}

int PID::incompleteDifferentialPID(float exceptionValue,float feedbackValue,float outputValue)
{
    float proportion=pidParam.ek-pidParam.ekk;
    float integration=pidParam.ek;
    float differ=pidParam.kd*(1-pidParam.alpha)*(pidParam.ek-2*pidParam.ekk+pidParam.ekkk)+pidParam.alpha*pidParam.lastDev;
    pidParam.increment=pidParam.kp*proportion+pidParam.ki*integration+pidParam.kd*differ;
    pidParam.lastDev=differ;
    pidParam.ekkk=pidParam.ekk;
    pidParam.ekk=pidParam.ek;
    outputValue = outputValue+pidParam.increment;
    return 0;
}

int PID::deadZonePID(float exceptionValue,float feedbackValue,float outputValue)
{

    pidParam.kp=10;
    pidParam.ki=10;
    pidParam.kd=10;

    pidParam.ek=exceptionValue-feedbackValue;
    if((pidParam.ek<pidParam.ekDeadZone)||(pidParam.ek>-pidParam.ekDeadZone))
    {
        pidParam.increment=0;
        pidParam.ek=0;
    }else {

        pidParam.increment = pidParam.kp*(pidParam.ek-pidParam.ekk)+pidParam.ki*pidParam.ek+pidParam.kd*(pidParam.ek-2*pidParam.ekk+pidParam.ekkk);

    }

    pidParam.ekkk=pidParam.ekk;
    pidParam.ekk=pidParam.ek;
    outputValue = outputValue+pidParam.increment;

    if(outputValue>pidParam.upLimit)
      {
       outputValue=pidParam.upLimit;
      }
     if(outputValue<pidParam.lowLimit)
      {
       outputValue=pidParam.lowLimit;
      }
    return 0;
}
int PID::fullPID(float exceptionValue,float feedbackValue,float outputValue)
{
    float up=0;//比例环节的输出
    float ui=0;//积分环节的输出
    float uk=0;//微分环节的输出
    outputValue=0;
    pidParam.ek=exceptionValue-feedbackValue;

    if(abs(pidParam.ek)<pidParam.ekDeadZone)//PID死区，小于死区则不进行调节，认为误差为零 PID不进行调节，防止稳定点频繁振荡
    {
        pidParam.increment=0;
        pidParam.ek=0;
    }else{
        if(abs(pidParam.ek)>pidParam.separationThreshold)//积分分离，误差大于阈值采用PID控制，误差小于阈值采用PID控制 防止超调
        {
            pidParam.ek=0;
        }

        up=pidParam.kp*(pidParam.ek-pidParam.ekk);
        ui=pidParam.ki*pidParam.ek;
        uk=pidParam.kd*(1-pidParam.alpha)*(pidParam.ek-2*pidParam.ekk+pidParam.ekkk)+pidParam.lastDev;//不完全微分环节，alpha为0~1的滤波系数 消除微分环节引入的高频噪声
        pidParam.increment=up+ui+uk;
    }

    pidParam.lastDev=uk;
    pidParam.ekkk=pidParam.ekk;
    pidParam.ekk=pidParam.ek;
    outputValue=outputValue+pidParam.increment;
    if(outputValue>pidParam.upLimit)
      {
       outputValue=pidParam.upLimit;
      }
    if(outputValue<pidParam.lowLimit)
     {
       outputValue=pidParam.lowLimit;
     }
     return 0;
}

引用：

https://blog.csdn.net/kuizhao8951/article/details/89508113?ops_request_misc=%257B%2522request%255Fid%2522%253A%2522162952512616780366515697%2522%252C%2522scm%2522%253A%252220140713.130102334…%2522%257D&request_id=162952512616780366515697&biz_id=0&utm_medium=distribute.pc_search_result.none-task-blog-2allsobaiduend~default-1-89508113.pc_search_download_positive&utm_term=PID%E9%9D%A2%E8%AF%95&spm=1018.2226.3001.4187

毅心一意111
关注
  • 11
    点赞
  • 踩
  • 80
    收藏
    觉得还不错? 一键收藏
  • 3
    评论
PLC PID控制优化系列之死区控制
RXXW_Dor的博客
03-30 5450
PID系列3，这些文章会给出PLC梯形图的源代码和SCL代码方便大家对比学习，受水平和能力所限，文章中难免出现错误和不严谨之处，也请大家指正。 在自动化控制系统中，由于系统特性和控制器精度等问题，致使系统偏差总是存在，系统总是频繁动作不能稳定。为了解决这种情况，我们可以引入带死区的PID控制算法， 其中的死区值得选择需要根据具体对象认真考虑，因为该值太小就起不到作用，该值选取过大则可能造成大的滞后，带死区的PID算法，对无论位置型还是增量型的表达式没有影响，不过它是一个非...
腾庆选煤厂重介密度控制系统中数字PID调节器的改进与应用
05-25
为解决腾庆选煤厂密度控制系统稳定性与抗干扰性差的问题,在原PI控制系统中引入微分控制,以增加系统的稳定性;引入积分分离法和抗积分饱和法,防止系统产生较大的超调和长时间的波动以及执行机构溢出;对微分项进行不完全微分改进,以提高系统的抗干扰性;在系统中引入死区控制,以避免系统频繁波动。经过技术改进后的控制系统调节速度快,稳定性强,控制精高,满足了现场生产需求。
现场使用的PID算法，C++
11-03
现场使用的PID算法，VS2012源代码，带有死区、控制区功能。
C51如何实现带死区控制的PID算法
10-21
真正要用PID算法的时候，发现书上的代码在我们51上来实现还不是那么容易的事情。简单的说来，就是不能直接调用...
图文详解PID调参&积分分离PID控制算法
最新发布
宁静致远的博客
02-28 718
提示：文章写完后，目录可以自动生成，如何生成可参考右边的帮助文档。
【电力电子技术DC-AC】三相SPWM逆变器Simulink仿真（设置死区时间）
qq_39400324的博客
01-24 6923
电力电子技术 三相SPWM逆变器Simulink仿真（设置死区时间）一、死区时间的影响二、Simulink仿真分析1.问题提出2.分析问题3.Simulink元件选取4.主电路图5.实际效果图四、仿真文件获取   本节是在上一节(三相SPWM逆变器Simulink仿真)的电路基础上对死区时间进行仿真分析，拓扑结构相同，如下图。所以电路仿真可参考上一节，本节仅在上一节电路的基础上添加死区时间模块。 一、死区时间的影响   桥式电路是大量实际逆变电路的基本结构，在理想情况下，每个桥臂的上下开关管严格轮流导通
PID控制器开发笔记之八：带死区的PID控制器的实现
木南创智
06-22 1万+
在计算机控制系统中，由于系统特性和计算精度等问题，致使系统偏差总是存在，系统总是频繁动作不能稳定。为了解决这种情况，我们可以引入带死区的PID算法。 1、带死区PID的基本思想 带死区的PID控制算法就是检测偏差值，若是偏差值达到一定程度，就进行调节。若是偏差值较小，就认为没有偏差。用公式表示如下： 其中的死区值得选择需要根据具体对象认真考虑，因为该值太小就起不到作用，该值选取过大则可能...
PID控制器开发笔记之六：不完全微分PID控制器的实现
木南创智
06-02 2万+
从PID控制的基本原理我们知道，微分信号的引入可改善系统的动态特性，但也存在一个问题，那就是容易引进高频干扰，在偏差扰动突变时尤其显出微分项的不足。为了解决这个问题人们引入低通滤波方式来解决这一问题。 1、不完全微分的基本思想 微分项有引入高频干扰的风险，但若在控制算法中加入低通滤波器，则可使系统性能得到改善。方法之一就是在PID算法中加入一个一阶低通滤波器。这...
不完全微分PID控制算法
SongYuLong
05-31 2591
不完全微分PID控制算法 注：本文内容摘自《先进PID控制MATLAB仿真（第4版）》刘金琨 编著，研读此书受益匪浅，感谢作者！ 在PID控制中，微分信号的引入可改善系统的动态特性，但也容易引起高频干扰，在误差扰动突变时尤其显出微分项的不足。若在控制算法中加入低通滤波器，则可以使系统性能得到改善。 克服上述缺点的方法之一是在PID算法中加入一个一阶惯性环节（低通滤波器）Gf(s)=11+TfSG_f(s)=\frac{1}{1+T_fS}Gf​(s)=1+Tf​S1​,可使系统得到改善。 ...
带死区的PID控制算法
SongYuLong
05-31 5131
带死区的PID控制算法带死区的PID控制算法: 注：本文内容摘自《先进PID控制MATLAB仿真（第4版）》刘金琨 编著，研读此书受益匪浅，感谢作者！ 带死区的PID控制算法: 在计算机控制系统中，某些系统为了避免控制作用过于频繁，消除由于频繁动作所引起的震荡，可采用带死区的PID控制算法，控制算式为： e(k)={0∣e(k)∣≤∣e0∣e(k)∣e(k)∣>∣e0∣e(k)=\begin{cases} 0 & \text{} |e(k)|\leq|e_0| \\ e(k) & \t
带死区的PID控制算法及仿真
qq_2645521500的博客
01-29 3075
在计算机控制系统中，某些系统为了避免控制作用过于频繁，消除由于频繁动作所引起的振荡，可采用带死区的PID控制算法.
积分分离PID控制算法及仿真-1
qq_2645521500的博客
01-21 3194
在普通 PID 控制中引入积分环节的目的，主要是为了消除静差，提高控制精度。但在过程的启动、结束或大幅度增减设定时，短时间内系统输出有很大的偏差，会造成PID运算的积分积累，致使控制量超过执行机构可能允许的最大动作范围对应的极限控制量，引起系统较大的超调，甚至引起系统较大的振荡。这在生产中是绝对不允许的。 积分分离控制基本思路是:当被控量与设定值偏差较大时，取消积分作用，以免由于积分作用使系统稳定性降低，超调量增大;当被控量接近给定值时，引入积分控制，以便消除静差，提高控制精度。其具体实现步骤如下:
电源技术中的高频开关电源的带死区的PID
11-16
在数字控制系统中，由于固有的...　如果不加人控制死区，则当误差e（n）已经落在误差带以内，但始终大于或小于零时，根据式（9－18），误差积分项的数值会随着时间不断地累计增大，容易引起控制系统的振荡。　来源:ks99
PID的死区 介绍
06-11
PID的死区 介绍
TIM—高级定时器-PWM互补输出带死区时间_stm32pwm互补输出带死区_
10-04
可以输出两路互补带死区的pwm，输出引脚，占空比，死区时间皆可调整
Quartusii18平台下基于FPGA的带死区的三相SPWM系统实现
06-18
1.领域：FPGA，带死区的三相SPWM系统 2.内容：Quartusii18平台下基于FPGA的带死区的三相SPWM系统实现 3.用处：用于带死区的三相SPWM系统编程学习 4.指向人群：本科，硕士，博士等教研使用 5.运行注意事项： ...
不完全微分PID控制算法用C语言实现！
魏波
02-01 5545
1.不完全微分PID控制算法框图 2.不完全微分PID控制算法公式 3.不完全微分PID控制公式用C语言实现 微分先行的PID算法实现，包括位置型和增量型两种实现方式。 （1）位置型 void PIDRegulation(PID *vPID, float processValue) { float thisError; float thisDev; t...
PID控制算法：从公式到伪代码
CKJ898的博客
03-08 2670
CAN协议学习不容易，今天虽然跳上了枝头，却终究还是没有变成凤凰···嘛，不管怎么样，先前的美好没留心，眼前的苟且还是要继续，```快乐就好，健康就是福``` 今天简单讲讲PID控制算法。 从实践上说，学一种算法，从公式（理论）和编程（应用）两个方面来学习，效率更优。 PID简介：在过程控制中，按偏差的比例（P）、积分（I）和微分（D）进行控制的PID控制器（亦称PID调节...
史上最详细的PID教程——理解PID原理及优化算法
热门推荐
name_longming的博客
03-22 11万+
Matlab动态PID仿真及PID知识梳理-云社区-华为云 (huaweicloud.com) 位置式PID与增量式PID区别浅析_Z小旋-CSDN博客_增量式pid 常用PID算法： ①PI算法： 特点： 从时域上看，只要存在偏差，积分就会不停对偏差积累，因此稳态时误差一定为零 不足：比例与积分动作都是对过去控制误差进行操作， 不对未来控制误差进行预测，限制了控制性能。 PI调节将比列调节的快速反应与积分调节消除静差的特点结合，实现好的调节效果。 PI调节适用于控制通道滞后较小、负荷变化不大、 工艺参数
带死区的pid算法 matlab
05-14
以下是带死区的PID算法的MATLAB代码示例： ```matlab function [u, e, i] = pid_deadzone(r, y, dt, kp, ki, kd, dz) % r: reference signal % y: feedback signal % dt: sampling time % kp, ki, kd: PID parameters % dz: deadzone value persistent err_sum prev_err if isempty(err_sum) err_sum = 0; end if isempty(prev_err) prev_err = 0; end err = r - y; if abs(err) <= dz err = 0; end derr = (err - prev_err) / dt; err_sum = err_sum + err * dt; u = kp * err + ki * err_sum + kd * derr; prev_err = err; e = err; i = err_sum; end ``` 此代码定义了一个名为 "pid_deadzone" 的函数，它需要输入参考信号 "r" 和反馈信号 "y"，以及采样时间 "dt"、比例增益 "kp"、积分增益 "ki"、微分增益 "kd" 和死区 "dz"。输出为控制信号 "u"、误差 "e" 和积分误差 "i"。 在函数的主体中，使用了 "persistent" 关键字来定义持久变量 "err_sum" 和 "prev_err"，以便在函数调用之间保持这些变量的值。然后计算误差 "err"，如果误差小于死区，则将其设置为零。接下来计算微分项 "derr" 和积分项 "err_sum"，并使用PID公式计算控制信号 "u"。 最后，将当前误差 "err" 和积分误差 "err_sum" 返回给调用程序。

“相关推荐”对你有帮助么？

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 3
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

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

抵扣说明：

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

余额充值