PID控制器开发笔记之四:梯形积分PID控制器的实现

从微积分的基本原理看,积分的实现是在无限细分的情况下进行的矩形加和计算。但是在离散状态下,时间间隔已经足够大,矩形积分在某些时候显得精度要低了一些,于是梯形积分被提出来以提升积分精度。

1、梯形积分基本思路

在PID控制其中,积分项的作用是消除余差,为了尽量减小余差,应提高积分项的运算精度。在积分项中,默认是按矩形方式来计算积分,将矩形积分改为梯形积分可以提高运算精度。其计算公式为:

于是如果在位置型PID算法中引入梯形积分则可以修改计算公式如下:

同样要在增量型PID算法中引入梯形积分则可以修改计算公式如下:

2、算法实现

从微积分的角度来说,当微分分到无限小时,矩形积分与梯形积分是没有区别的。但事实上我们的采样时间不可能无限小,而且也不可能是连续的,那么采样周期越大,那么矩形近似于实际曲线间的偏差就越大,而梯形积分则可以更加接近实际曲线,所以采用梯形积分代替矩形积分就可以得到更高的精度。

1)位置型PID算法实现

位置型PID的实现在前面就已经完成,所不同的是前面使用的是矩形积分,在这一节我们将举行积分部分改为梯形积分,同样首先定义PID对象的结构体:

 1 /*定义结构体和公用体*/
 2
 3 typedef struct
 4
 5 {
 6
 7   float setpoint;       //设定值
 8
 9   float proportiongain;     //比例系数
10
11   float integralgain;      //积分系数
12
13   float derivativegain;    //微分系数
14
15   float lasterror;     //前一拍偏差
16
17   float result; //输出值
18
19   float integral;//积分值
20
21 }PID;

接下来实现PID控制器:

 1 void PIDRegulation(PID *vPID, float processValue)
 2
 3 {
 4
 5   float thisError;
 6
 7
 8
 9   thisError=vPID->setpoint-processValue;
10
11   vPID->integral+=(thisError+ vPID-> lasterror)/2;
12
13   vPID->result=vPID->proportiongain*thisError+vPID->integralgain*vPID->integral+vPID->derivativegain*(thisError-vPID->lasterror);
14
15   vPID->lasterror=thisError;
16
17 }

从上述实现我们不难看出,变化仅仅只是在做积分累计vPID->integral时,将累计量按梯形方式累计。

2)增量型PID算法实现

同样的增量型PID的梯形积分实现也就是即将积分部分有矩形积分部分换成梯形积分即可。首先定义PID对象的结构体:

 1 /*定义结构体和公用体*/
 2
 3 typedef struct
 4
 5 {
 6
 7   float setpoint;       //设定值
 8
 9   float proportiongain;     //比例系数
10
11   float integralgain;      //积分系数
12
13   float derivativegain;    //微分系数
14
15   float lasterror;     //前一拍偏差
16
17   float preerror;     //前两拍偏差
18
19   float deadband;     //死区
20
21   float result; //输出值
22
23 }PID;

接下来实现PID控制器:

 1 void PIDRegulation(PID *vPID, float processValue)
 2
 3 {
 4
 5   float thisError;
 6
 7   float increment;
 8
 9   float pError,dError,iError;
10
11
12
13   thisError=vPID->setpoint-processValue; //得到偏差值
14
15   pError=thisError-vPID->lasterror;
16
17   iError=(thisError+ vPID-> lasterror)/2;
18
19   dError=thisError-2*(vPID->lasterror)+vPID->preerror;
20
21   increment=vPID->proportiongain*pError+vPID->integralgain*iError+vPID->derivativegain*dError;   //增量计算
22
23
24
25   vPID->preerror=vPID->lasterror;  //存放偏差用于下次运算
26
27   vPID->lasterror=thisError;
28
29   vPID->result+=increment;
30
31 }

3、总结

积分项的引入目的就是为了消除系统的余差,那么积分项的计算精度越高,对消除系统的余差就越有利。梯形积分相较于矩形积分其精度有比较大的提高,所以对消除余差也就越有效。

欢迎关注:

原文地址:https://www.cnblogs.com/foxclever/p/9031556.html

时间: 2024-11-05 12:18:21

PID控制器开发笔记之四:梯形积分PID控制器的实现的相关文章

PID控制器开发笔记之三:抗积分饱和PID控制器的实现

积分作用的引入是为了消除系统的静差,提高控制精度.但是如果一个系统总是存在统一个方向的偏差,就可能无限累加而进而饱和,极大影响系统性能.抗积分饱和就是用以解决这一问题的方法之一.这一节我们就来实现抗积分饱和的PID算法. 1.抗积分饱和的基本思想 所谓积分饱和就是指系统存在一个方向的偏差,PID控制器的输出由于积分作用的不断累加而扩大,从而导致控制器输出不断增大超出正常范围进入饱和区.当系统出现反响的偏差时,需要首先从饱和区退出,而不能对反向的偏差进行快速的响应. 为了解决积分饱和的问题,人们引

PID控制器开发笔记之二:积分分离PID控制器的实现

前面的文章中,我们已经讲述了PID控制器的实现,包括位置型PID控制器和增量型PID控制器.但这个实现只是最基本的实现,并没有考虑任何的干扰情况.在本节及后续的一些章节,我们就来讨论一下经典PID控制器的优化与改进.这一节我们首先来讨论针对积分项的积分分离优化算法. 1.基本思想 我们已经讲述了PID控制引入积分主要是为了消除静差,提高控制精度.但在过程的启动.结束或大幅度增减设定值时,短时间内系统输出有很大偏差,会造成PID运算的积分累积,引起超调或者振荡.为了解决这一干扰,人们引入了积分分离

Modbus库开发笔记之四:Modbus TCP Client开发

这一次我们封装Modbus TCP Client应用.同样的我们也不是做具体的应用,而是实现TCP客户端的基本功能.我们将TCP客户端的功能封装为函数,以便在开发具体应用时调用. 对于TCP客户端我们主要实现的功能有两个:其一是生成访问TCP服务器的命令,总共支持8中功能码.其二是对TCP服务器端返回的信息进行解析并根据结果进行各种操作,同样也是支持8中功能吗的操作.具体软件访问结构如下: 1.访问命令的生成 客户端作为主动交互端,需要向服务器发各种操作请求命令.所以对于TCP客户端来说,首先要

STM32F412应用开发笔记之四:与远红外炭氢传感器通讯

远红外炭氢传感器是在多组分气体传感器中用来检测甲烷和丙烷浓度的,采用单总线串行通讯,TTL电平.所以我们需要用到UART口来实现与远红外炭氢传感器的通讯. 远红外传感器就是这个样子的: 再来一张进气和出气口的照片: 我们设计的是使用USART1和USART3,但由于NUCLEO-F412ZG试验板上USART1的引脚PA9和PA10已经用于USB端口,USART3的引脚PD8和PD9也已经用于连接ST-LINK的串行通讯,所以我们使用了USART2和USART6. 查看NUCLEO-F412ZG

PID控制器(比例-积分-微分控制器)- IV

调节/测量放大电路电路图:PID控制电路图 如图是PlD控制电路,即比例(P).积分(I).微分(D)控制电路. A1构成的比例电路与环路增益有关,调节RP1,可使反相器的增益在0·5一∞范围内变化; A2是积分电路,积分时间常数可在22一426S范围内变化; A3是微分电路,时间常数由Cl(Rl+R(RP3))决定; A4将比例.积分.微分各电路输出倒相后合成为U. Controller Circuit This circuit is the basis of a temperature co

PID控制器(比例-积分-微分控制器)- II

Table of Contents Practical Process Control Proven Methods and Best Practices for Automatic PID Control I. Modern Control is Based on Process Dynamic Behavior (by Doug Cooper) 1) Fundamental Principles of Process Control Motivation and Terminology of

python运维开发笔记4

1.函数如何被调用,通过return返回值来调用 2.生成器和return区别 yield 生成器返回对象,可以迭代 可以执行 glob模块 类似shell中的正则匹配 shlex模块  Popen 将命令参数直接分词 cmd = "ps ax -o pid,ppid,cmd" shlex.split(cmd) ['ps','ax','-o','pid,ppid,cmd'] ['mysql','-u','root','-p123','-e','show processlist'] p

Android开发笔记(一百零七)统计分析SDK

APP统计分析 用户画像 对程序员来说,用户画像就是用户的属性和行为:通俗地说,用户画像是包括了个人信息.兴趣爱好.日常行为等血肉丰满的客户实体.用户画像是精准营销的产物,企业通过收集用户的行为,然后分析出用户的特征与偏好,进而挖掘潜在的商业价值,实现企业效益的最大化. 用户画像的一个具体应用是电商app的"猜你喜欢"栏目,电商平台通过对用户购买过的商品进行统计,可以分析用户日常生活用的是什么物品:电商平台还可以对用户的搜索行为.浏览行为进行统计,从中分析用户感兴趣的商品,或者说考虑购

[Openwrt 项目开发笔记]:PHP+Nginx安装(七)

在上一节中,我们已经搭建了MySQL数据库了,因此在这一节中,我主要讲解php的安装,以及php的运行环境Nginx的安装.参考(http://www.right.com.cn/forum/thread-89216-1-1.html) 一.PHP安装 1.安装php软件包. opkg updateopkg install php5 php5-mod-apc opkg install php5-mod-gd php5-mod-session opkg install php5-mod-pdo-my