增量式PID控制算法程序
- 格式:doc
- 大小:47.50 KB
- 文档页数:23
增量式PID的整型算法对于PID控制的程序算法,很多书上都讲了。
但是,最近真正要用PID算法的时候,发现书上的代码在我们51单片机上来实现还不是那么容易的事情。
简单的说来,就是不能直接调用。
仔细分析你可以发现,教材上的、网上现行的PID实现的C语言代码几乎都是用浮点型的数据来做的,可以想象,如果我们的计算使用浮点数据,那我们的51单片机来运行的话会有多痛苦。
所以,本人自己琢磨着弄了一个整型变量来实现了PID算法,由于是用整型数来做的,所以也不是很精确,但是对于很多的使用场合,这个精度也够了。
关于系数和采样电压全部是放大10倍处理的。
所以精度不是很高,但是也不是那么低,大部分的场合都够用了。
实在觉得精度不够,可以再放大10倍或者100倍处理,但是要注意不超出整个数据类型的范围就可以了。
以下是具体的程序代码:typedef struct PIDValue{uint32 Ek_Uint32[3]; //差值保存,给定和反馈的差值uint8 EkFlag_Uint8[3]; //符号,1则对应的Ek[i]为负数,0为对应的Ek[i]为正数uint8 KP_Uint8;uint8 KI_Uint8;uint8 KD_Uint8;uint8 B_Uint8; //死区电压uint8 KP; //显示修改的时候用uint8 KI;uint8 KD;uint8 B;uint16 Uk_Uint16; //上一时刻的控制电压}PIDValueStr;PIDValueStr xdata PID;//PID = Uk + (KP*E(k) - KI*E(k-1) + KD*E(k-2));void PIDProcess(void){uint32 idata Temp[3]; //uint32 idata PostSum; //正数和uint32 idata NegSum; //负数和Temp[0] = 0;Temp[1] = 0;Temp[2] = 0;PostSum = 0;NegSum = 0;if( ADPool.Value_Uint16[UINADCH] > ADPool.Value_Uint16[UFADCH] )//给定大于反{Temp[0] = ADPool.Value_Uint16[UINADCH] - ADPool.Value_Uint16[UFADCH];//计算Ek[0]if( Temp[0] > PID.B_Uint8 ){//数值移位PID.Ek_Uint32[2] = PID.Ek_Uint32[1];PID.Ek_Uint32[1] = PID.Ek_Uint32[0];PID.Ek_Uint32[0] = Temp[0];//符号移位PID.EkFlag_Uint8[2] = PID.EkFlag_Uint8[1];PID.EkFlag_Uint8[1] = PID.EkFlag_Uint8[0];PID.EkFlag_Uint8[0] = 0; //当前EK为正数Temp[0] = (uint32)PID.KP_Uint8 * PID.Ek_Uint32[0]; // KP*EK0Temp[1] = (uint32)PID.KI_Uint8 * PID.Ek_Uint32[1]; // KI*EK1Temp[2] = (uint32)PID.KD_Uint8 * PID.Ek_Uint32[2]; // KD*EK2}}else //反馈大于给定{Temp[0] = ADPool.Value_Uint16[UFADCH] - ADPool.Value_Uint16[UINADCH]; //计算Ek[0]if( Temp[0] > PID.B_Uint8 ){//数值移位PID.Ek_Uint32[2] = PID.Ek_Uint32[1];PID.Ek_Uint32[1] = PID.Ek_Uint32[0];PID.Ek_Uint32[0] = Temp[0];//符号移位PID.EkFlag_Uint8[2] = PID.EkFlag_Uint8[1];PID.EkFlag_Uint8[1] = PID.EkFlag_Uint8[0];PID.EkFlag_Uint8[0] = 1; //当前EK为负数Temp[0] = (uint32)PID.KP_Uint8 * PID.Ek_Uint32[0]; // KP*EK0Temp[1] = (uint32)PID.KI_Uint8 * PID.Ek_Uint32[1]; // KI*EK1Temp[2] = (uint32)PID.KD_Uint8 * PID.Ek_Uint32[2]; // KD*EK2}}/*以下部分代码是讲所有的正数项叠加,负数项叠加*/if(PID.EkFlag_Uint8[0]==0){PostSum += Temp[0]; //正数和}else{NegSum += Temp[0]; //负数和} // KP*EK0if(PID.EkFlag_Uint8[1]!=0){PostSum += Temp[1]; //正数和}else{NegSum += Temp[1]; //负数和} // - kI * EK1if(PID.EkFlag_Uint8[2]==0){PostSum += Temp[2]; //正数和}else{NegSum += Temp[2]; //负数和} // KD * EK2PostSum += (uint32)_Uint16; //if( PostSum > NegSum ) // 是否控制量为正数{Temp[0] = PostSum - NegSum;if( Temp[0] < (uint32)ADPool.Value_Uint16[UMAXADCH] )//小于限幅值则为计算值输出 {_Uint16 = (uint16)Temp[0];}else{_Uint16 = ADPool.Value_Uint16[UMAXADCH]; //否则为限幅值输出}}else //控制量输出为负数,则输出0{_Uint16 = 0;}}=============================================================================== //总体调节=比例系数×压力误差+积分系数×积分误差+微分系数×(本次误差-前次误差)//P就是比例,就是输入偏差乘以一个系数;//I就是积分,就是对输入偏差进行积分运算;//D就是微分,对输入偏差进行微分运算;PIDValueStr xdata PID;void PIDCalc(unsigned int idata data1,unsigned int idata data2,unsigned int idata minfreq){unsigned int idata svdata;unsigned int idata pvdata;unsigned long idata dError,Error;unsigned long idata ResultP,ResultI,ResultD,PIDout,Result;svdata=data1;pvdata=data2;if(svdata>pvdata){Error=svdata-pvdata;// 压力偏差PID.SumError+=Error;// 积分dError=PID.LError-PID.PError;// 当前微分PID.PError=PID.LError;PID.LError=Error;ResultP=PID.KP*Error*100;// 比例项ResultI=PID.KI*(PID.SumError);// 积分项ResultD=PID.KD*dError;// 微分项PIDout=ResultP+ResultI+ResultD;Result+=PIDout;if(PIDout>=5000){PIDout=5000;PID.SumError-=Error;}else{ PIDout=ResultP+ResultI+ResultD;}}if(svdata<pvdata){Error=svdata-pvdata;// 压力偏差PID.SumError+=Error;// 积分dError=PID.LError-PID.PError;// 当前微分PID.PError=PID.LError;PID.LError=Error;ResultP=PID.KP*Error*100;//比例项ResultI=PID.KI*(PID.SumError);// 积分项ResultD=PID.KD*dError;// 微分项PIDout=ResultP+ResultI+ResultD;Result+=PIDout;if (PIDout>=5000){PIDout=0;PID.SumError-=Error;}else{ PIDout=ResultP+ResultI+ResultD;}}if (PIDout<minfreq){PIDout=0;}=PIDout; }。
PID控制算法的C语言实现一 PID算法原理之迟辟智美创作最近两天在考虑一般控制算法的C语言实现问题,发现网络上尚没有一套完整的比力体系的讲解.于是总结了几天,整理一套思路分享给年夜家.在工业应用中PID及其衍生算法是应用最广泛的算法之一,是当之无愧的万能算法,如果能够熟练掌握PID算法的设计与实现过程,对一般的研发人员来讲,应该是足够应对一般研发问题了,而难能可贵的是,在我所接触的控制算法傍边,PID控制算法又是最简单,最能体现反馈思想的控制算法,可谓经典中的经典.经典的未必是复杂的,经典的工具经常是简单的,而且是最简单的,想想牛顿的力学三年夜定律吧,想想爱因斯坦的质能方程吧,何等的简单!简单的不是原始的,简单的也不是落后的,简单到了美的水平.先看看PID算法的一般形式:PID的流程简单到了不能再简单的水平,通过误差信号控制被控量,而控制器自己就是比例、积分、微分三个环节的加和.这里我们规定(在t时刻):1.输入量为rin(t);2.输出量为rout(t);3.偏差量为err(t)=rin(t)rout(t);pid的控制规律为理解一下这个公式,主要从下面几个问题着手,为了便于理解,把控制环境具体一下:1.规定这个流程是用来为直流机电调速的;2.输入量rin(t)为机电转速预定值;3.输出量rout(t)为机电转速实际值;4.执行器为直流机电;5.传感器为光电码盘,假设码盘为10线;6.直流机电采纳PWM调速转速用单元转/min 暗示;不难看出以下结论:1.输入量rin(t)为机电转速预定值(转/min);2. 输出量rout(t)为机电转速实际值(转/min);3.偏差量为预定值和实际值之差(转/min);那么以下几个问题需要弄清楚:1.通过PID环节之后的U(t)是什么值呢?2.控制执行器(直流机电)转动转速应该为电压值(也就是PWM占空比).3.那么U(t)与PWM之间存在怎样的联系呢?/user1/3407/archives//33541.html(见附录1)这篇文章上给出了一种方法,即,每个电压对应一个转速,电压和转速之间呈现线性关系.可是我考虑这种方法的前提是把直流机电的特性理解为线性了,而实际情况下,直流机电的特性绝对不是线性的,或者说在局部上是趋于线性的,这就是为什么说PID调速有个范围的问题.具体看一下/component/article90249.htm (见附录2)这篇文章就可以了解了.所以在正式进行调速设计之前,需要现有开环系统,测试机电和转速之间的特性曲线(或者查阅机电的资料说明),然后再进行闭环参数整定.这篇先写到这,下一篇说明连续系统的离散化问题.并根据离散化后的特点讲述位置型PID和增量型PID的用法和C语言实现过程.PID控制算法的C语言实现二 PID算法的离散化上一节中,我论述了PID算法的基本形式,并对其控制过程的实现有了一个简要的说明,通过上一节的总结,基本已经可以明白PID控制的过程.这一节中先继续上一节内容弥补说明一下.1.说明一下反馈控制的原理,通过上一节的框图不难看出,PID控制其实是对偏差的控制过程;2.如果偏差为0,则比例环节不起作用,只有存在偏差时,比例环节才起作用.3.积分环节主要是用来消除静差,所谓静差,就是系统稳定后输出值和设定值之间的差值,积分环节实际上就是偏差累计的过程,把累计的误差加到原有系统上以抵消系统造成的静差.4.而微分信号则反应了偏差信号的变动规律,或者说是变动趋势,根据偏差信号的变动趋势来进行超前调节,从而增加了系统的快速性.好了,关于PID的基本说明就弥补到这里,下面将对PID 连续系统离散化,从而方便在处置器上实现.下面把连续状态的公式再贴一下:假设采样间隔为T,则在第KT时刻:偏差err(K)=rin(K)rout(K);积分环节用加和的形式暗示,即err(K)+err(K+1)+……;微分环节用斜率的形式暗示,即[err(K)err(K1)]/T;从而形成如下PID离散暗示形式:则u(K)可暗示成为:至于说Kp、Ki、Kd三个参数的具体表达式,我想可以轻松的推出了,这里节省时间,不再详细暗示了.其实到这里为止,PID的基本离散暗示形式已经出来了.目前的这种表述形式属于位置型PID,另外一种表述方式为增量式PID,由U上述表达式可以轻易获得:那么:这就是离散化PID的增量式暗示方式,由公式可以看出,增量式的表达结果和最近三次的偏差有关,这样就年夜年夜提高了系统的稳定性.需要注意的是最终的输出结果应该为u(K)+增量调节值;PID的离散化过程基本思路就是这样,下面是将离散化的公式转换成为C语言,从而实现微控制器的控制作用.PID控制算法的C语言实现三位置型PID的C语言实现上一节中已经笼统出了位置性PID和增量型PID的数学表达式,这一节,重点讲解C语言代码的实现过程,算法的C语言实现过程具有一般性,通过PID算法的C语言实现,可以以此类推,设计其它算法的C语言实现.第一步:界说PID变量结构体,代码如下:struct _pid{float SetSpeed; //界说设定值float ActualSpeed; //界说实际值float err; //界说偏差值float err_last; //界说上一个偏差值float Kp,Ki,Kd; //界说比例、积分、微分系数float voltage; //界说电压值(控制执行器的变量)float integral; //界说积分值}pid;控制算法中所需要用到的参数在一个结构体中统一界说,方便后面的使用.第二部:初始化变量,代码如下:void PID_init(){printf("PID_init begin \n");pid.SetSpeed=0.0;pid.err=0.0;pid.err_last=0.0;pid.voltage=0.0;pid.integral=0.0;pid.Kp=0.2;pid.Ki=0.015;pid.Kd=0.2;printf("PID_init end \n");}统一初始化变量,尤其是Kp,Ki,Kd三个参数,调试过程傍边,对要求的控制效果,可以通过调节这三个量直接进行调节.第三步:编写控制算法,代码如下:float PID_realize(float speed){pid.SetSpeed=speed;pid.err=pid.SetSpeedpid.ActualSpeed;pid.integral+=pid.err;pid.voltage=pid.Kp*pid.err+pid.Ki*pid.integral+pid.Kd*(pid. errpid.err_last); pid.err_last=pid.err;pid.ActualSpeed=pid.voltage*1.0;}注意:这里用了最基本的算法实现形式,没有考虑死区问题,没有设定上下限,只是对公式的一种直接的实现,后面的介绍傍边还会逐渐的对此改进.到此为止,PID的基本实现部份就初步完成了.下面是测试代码:int main(){printf("System begin \n");PID_init();int count=0;while(count<1000){float speed=PID_realize(200.0);printf("%f\n",speed);count++;}return 0;}下面是经过1000次的调节后输出的1000个数据(具体的参数整定过程就不说明了,网上这种说明非常多):PID控制算法的C语言实现四增量型PID的C语言实现上一节中介绍了最简单的位置型PID的实现手段,这一节主要讲解增量式PID的实现方法,位置型和增量型PID的数学公式请拜会我的系列文《PID控制算法的C语言实现二》中的讲解.实现过程仍然是分为界说变量、初始化变量、实现控制算法函数、算法测试四个部份,详细分类请介入《PID控制算法的C 语言实现三》中的讲解,这里直接给出代码了.#include<stdio.h>#include<stdlib.h>struct _pid{float SetSpeed; //界说设定值float ActualSpeed; //界说实际值float err; //界说偏差值float err_next; //界说上一个偏差值float err_last; //界说最上前的偏差值float Kp,Ki,Kd; //界说比例、积分、微分系数}pid;void PID_init(){pid.SetSpeed=0.0;pid.ActualSpeed=0.0;pid.err=0.0;pid.err_last=0.0;pid.err_next=0.0;pid.Kp=0.2;pid.Ki=0.015;pid.Kd=0.2;}float PID_realize(float speed){pid.SetSpeed=speed;pid.err=pid.SetSpeedpid.ActualSpeed;floatincrementSpeed=pid.Kp*(pid.errpid.err_next)+pid.Ki*pid.err+pid.Kd*(pid.err2*pid.err_next+pid.err_last);pid.ActualSpeed+=incrementSpeed;pid.err_last=pid.err_next;pid.err_next=pid.err;return pid.ActualSpeed;}int main(){PID_init();int count=0;while(count<1000){float speed=PID_realize(200.0);printf("%f\n",speed);count++;}return 0;}运行后的1000个数据为:PID控制算法的C语言实现五积分分离的PID控制算法C语言实现通过三、四两篇文章,基本上已经弄清楚了PID控制算法的最惯例的表达方法.在普通PID控制中,引入积分环节的目的,主要是为了消除静差,提高控制精度.可是在启动、结束或年夜幅度增减设按时,短时间内系统输出有很年夜的偏差,会造成PID运算的积分积累,招致控制量超越执行机构可能允许的最年夜举措范围对应极限控制量,从而引起较年夜的超调,甚至是震荡,这是绝对不允许的.为了克服这一问题,引入了积分分离的概念,其基本思路是当被控量与设定值偏差较年夜时,取消积分作用; 当被控量接近给定值时,引入积分控制,以消除静差,提高精度.其具体实现代码如下:pid.Kp=0.2;pid.Ki=0.04;pid.Kd=0.2; //初始化过程if(abs(pid.err)>200){index=0;}else{index=1;pid.integral+=pid.err;}pid.voltage=pid.Kp*pid.err+index*pid.Ki*pid.integral+pid.Kd*(p id.errpid.err_last); //算法具体实现过程其它部份的代码拜会《PID控制算法的C语言实现三》中的讲解,不再赘述.同样收集1000个量,会发现,系统到199所有的时间是原来时间的1/2,系统的快速性获得了提高.PID控制算法的C语言实现六抗积分饱和的PID控制算法C语言实现所谓的积分饱和现象是指如果系统存在一个方向的偏差,PID控制器的输出由于积分作用的不竭累加而加年夜,从而招致执行机构到达极限位置,若控制器输出U(k)继续增年夜,执行器开度不成能再增年夜,此时计算机输出控制量超越了正常运行范围而进入饱和区.一旦系统呈现反向偏差,u(k)逐渐从饱和区退出.进入饱和区越深则退出饱和区时间越长.在这段时间里,执行机构仍然停留在极限位置而不随偏差反向而立即做出相应的改变,这时系统就像失控一样,造成控制性能恶化,这种现象称为积分饱和现象或积分失控现象.防止积分饱和的方法之一就是抗积分饱和法,该方法的思路是在计算u(k)时,首先判断上一时刻的控制量u(k1)是否已经超越了极限范围:如果u(k1)>umax,则只累加负偏差; 如果u(k1)<umin,则只累加正偏差.从而防止控制量长时间停留在饱和区.直接贴出代码,不懂的看看前面几节的介绍.struct _pid{float SetSpeed; //界说设定值float ActualSpeed; //界说实际值float err; //界说偏差值float err_last; //界说上一个偏差值float Kp,Ki,Kd; //界说比例、积分、微分系数float voltage; //界说电压值(控制执行器的变量)float integral; //界说积分值float umax;float umin;}pid;void PID_init(){printf("PID_init begin \n");pid.SetSpeed=0.0;pid.ActualSpeed=0.0;pid.err=0.0;pid.err_last=0.0;pid.voltage=0.0;pid.integral=0.0;pid.Kp=0.2;pid.Ki=0.1; //注意,和上几次相比,这里加年夜了积分环节的值pid.Kd=0.2;pid.umax=400;pid.umin=200;printf("PID_init end \n");}float PID_realize(float speed){int index;pid.SetSpeed=speed;pid.err=pid.SetSpeedpid.ActualSpeed;if(pid.ActualSpeed>pid.umax) //灰色底色暗示抗积分饱和的实现{if(abs(pid.err)>200) //蓝色标注为积分分离过程{index=0;}else{index=1;if(pid.err<0){pid.integral+=pid.err;}}}else if(pid.ActualSpeed<pid.umin){if(abs(pid.err)>200) //积分分离过程{index=0;}else{index=1;if(pid.err>0){pid.integral+=pid.err;}}}else{if(abs(pid.err)>200)//积分分离过程{index=0;}else{index=1;pid.integral+=pid.err;}}pid.voltage=pid.Kp*pid.err+index*pid.Ki*pid.integral+pid.Kd*(p id.errpid.err_last);pid.err_last=pid.err;pid.ActualSpeed=pid.voltage*1.0;return pid.ActualSpeed;}最终的测试法式运算结果如下,可以明显的看出系统的稳按时间相对前几次来讲缩短了很多.PID控制算法的C语言实现七梯形积分的PID控制算法C语言实现先看一下梯形算法的积分环节公式作为PID控制律的积分项,其作用是消除余差,为了尽量减小余差,应提高积分项运算精度,为此可以将矩形积分改为梯形积分,具体实现的语句为:pid.voltage=pid.Kp*pid.err+index*pid.Ki*pid.integral/2+pid.Kd*(pid.er rpid.err_last); //梯形积分其它函数请拜会本系列教程六中的介绍最后运算的稳定命据为:199.999878,较教程六中的199.9999390而言,精度进一步提高.PID控制算法的C语言实现八变积分的PID控制算法C语言实现变积分PID可以看成是积分分离的PID算法的更一般的形式.在普通的PID控制算法中,由于积分系数ki是常数,所以在整个控制过程中,积分增量是不变的.可是,系统对积分项的要求是,系统偏差年夜时,积分作用应该减弱甚至是全无,而在偏差小时,则应该加强.积分系数取年夜了会发生超调,甚至积分饱和,取小了又不能短时间内消除静差.因此,根据系统的偏差年夜小改变积分速度是有需要的.变积分PID的基本思想是设法改变积分项的累加速度,使其与偏差年夜小相对应:偏差越年夜,积分越慢; 偏差越小,积分越快.这里给积分系数前加上一个比例值index:当abs(err)<180时,index=1;当180<abs(err)<200时,index=(200abs(err))/20;当abs(err)>200时,index=0;最终的比例环节的比例系数值为ki*index;具体PID实现代码如下:pid.Kp=0.4;pid.Ki=0.2; //增加了积分系数pid.Kd=0.2;float PID_realize(float speed){float index;pid.SetSpeed=speed;pid.err=pid.SetSpeedpid.ActualSpeed;if(abs(pid.err)>200) //变积分过程{index=0.0;}else if(abs(pid.err)<180){index=1.0;pid.integral+=pid.err;}else{index=(200abs(pid.err))/20;pid.integral+=pid.err;}pid.voltage=pid.Kp*pid.err+index*pid.Ki*pid.integral+pid.Kd*(p id.errpid.err_last);pid.err_last=pid.err;pid.ActualSpeed=pid.voltage*1.0;return pid.ActualSpeed;}最终结果可以看出,系统的稳定速度非常快(测试法式拜会本系列教程3):120.00 0000 64.000 000 148.80 0003 96.959 999 165.63 120.93 4395 177.30 0476 139.08 1223 185.46 9742 152.89 8834 191.13 9313 163.45 2988 195.022278171.538986197.635025177.753738199.350967182.546188200.439255186.254608201.093094189.134460201.450439191.379044201.609268193.135010201.638611194.513870201.586670195.600708201.486694196.460571201.361328197.143387201.225632197.687561201.089340198.122787200.958511198.472076200.836655198.753296200.725555198.980423200.625870199.164398200.537506199.313843200.459900199.435547200.392258199.534912200.333679199.616211200.283203199.682877200.239899199.737640200.202866199.782700200.171295199.819855200.144470199.850525200.121704199.875870200.102432199.896851200.086136199.914230200.072372199.928635200.060776199.940582200.051010199.950500200.042801199.958755200.035904199.965622200.030090199.971344200.025223199.976105200.021118 199.98 0057 200.01 7700 199.98 3353 200.01 4832 199.98 6099 200.01 2421 199.98 8403 200.01 0391 199.99 0326 200.00 8698 199.99 1928 200.00 7263 199.99 3256 200.00 6088 199.99 4370 200.00 5081 199.99 5300 200.00 4257 199.99 6063 200.00 3555 199.99 6719 200.002975199.997253200.002487199.997711200.002075199.998077200.001740199.998398200.001465199.998657200.001221199.998886200.001007199.999084200.000839199.999237200.000702199.999359200.000580199.999451200.000488199.999542200.000397199.999619200.000336199.999680200.000275199.999725200.000229199.999756200.000198199.999802200.000168199.999832200.000137199.999863200.000107199.999893200.000092199.999908200.000076199.999924200.000061199.999939200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.00199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.99 9954 200.00 0046 199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046199.999954200.000046PID控制算法的C语言实现九专家PID与模糊PID 的C语言实现本节是PID控制算法的C语言实现系列的最后一节,前面8节中,已经分别从PID的实现到深入的过程进行了一个简要的讲解,畴前面的讲解中不难看出,PID的控制思想非常简单,其主要问题点和难点在于比例、积分、微分环节上的参数整定过程,对执行器控制模型确定或者控制模型简单的系统而言,参数的整定可以通过计算获得,对一般精度要求不是很高的执行器系统,可以采纳拼凑的方法进行实验型的整定.然而,在实际的控制系统中,线性系统究竟是少数,年夜部份的系统属于非线性系统,或者说是系统模型不确定的系统,如果控制精度要求较高的话,那么对参数的整定过程是有难度的.专家PID和模糊PID就是为满足这方面的需求而设计的.专家算法和模糊算法都归属于智能算法的范畴,智能算法最年夜的优点就是在控制模型未知的情况下,可以对模型进行控制.这里需要注意的是,专家PID也好,模糊PID也罢,绝对不是专家系统或模糊算法与PID控制算法的简单加和,他是专家系统或者模糊算法在PID控制器参数整定上的应用.也就是说,智能算法是辅助PID进行参数整定的手段.其实在前面几节的讲述中,已经用到了专家PID的一些特例行为了,从第五节到第八节都是专家系统一些特列化的算法,对某些条件进行了局部的判定,比如如果偏差太年夜的话,就去除积分项,这自己就是含有经验的专家系统.专家系统、模糊算法,需要参数整定就一定要有整定的依据,也就是说什么情况下整定什么值是要有依据的,这个依据是一些逻辑的组合,只要找出其中的逻辑组合关系来,这些依据就再明显不外了.下面先说一下专家PID的C语言实现.正如前面所说,需要找到一些依据,还得从PID系数自己说起.1.比例系数Kp的作用是加快系统的响应速度,提高系统的调节精度.Kp 越年夜,系统的响应速度越快,系统的调节精度越高,可是容易发生超调,甚至会使系统不稳定.Kp取值过小,则会降低调节精度,使响应速度缓慢,从而延长调节时间,是系统静态、静态特性变差;2.积分作用系数Ki的作用是消除系统的稳态误差.Ki越年夜,系统的静态误差消除的越快,可是Ki过年夜,在响应过程的早期会发生积分饱和的现象,从而引起响应过程的较年夜超调.若Ki过小,将使系统静态误差难以消除,影响系统的调节精度;3.微分系数Kd的作用是改善系统的静态特性,其作用主要是在响应过程中抑制偏差向任何方向的变动,对偏差变动进行提前预报.可是kd过年夜,会使响应过程提前制动,从而延长调节时间,而且会降低系统的抗干扰性.反应系统性能的两个参数是系统误差e和误差变动律ec,这点还是好理解的:首先我们规定一个误差的极限值,假设为Mmax;规定一个误差的比力年夜的值,假设为Mmid;规定一个误差的较小值,假设为Mmin;当abs(e)>Mmax时,说明误差的绝对值已经很年夜了,不论误差变动趋势如何,都应该考虑控制器的输入应按最年夜(或最小)输出,以到达迅速调整误差的效果,使误差绝对值以最年夜的速度减小.此时,相当于实施开环控制.当e*ec>0时,说明误差在朝向误差绝对值增年夜的方向变动,此时,如果abs(e)>Mmid,说明误差也较年夜,可考虑由控制器实施较强的控制作用,以到达扭转误差绝对值向减小的方向变动,并迅速减小误差的绝对值.此时如果abs(e)<Mmid,说明尽管误差是向绝对值增年夜的方向变动,可是误差绝对值自己其实不是很年夜,可以考虑控制器实施一般的控制作用,只需要扭转误差的变动趋势,使其向误差绝对值减小的方向变动即可.当e*err<0且e*err(k1)>0或者e=0时,说明误差的绝对值向减小的方向变动,或者已经到达平衡状态,此时坚持控制器输出不变即可.当e*err<0且e*err(k1)<0时,说明误差处于极限状态.如果此时误差的绝对值较年夜,年夜于Mmin,可以考虑实施较强控制作用.如果此时误差绝对值较小,可以考虑实施较弱控制作用.当abs(e)<Mmin时,说明误差绝对值很小,此时加入积分,减小静态误差.上面的逻辑判断过程,实际上就是对控制系统的一个专家判断过程.(未完待续)PID控制算法的C语言实现十模糊算法简介在PID控制算法的C语言实现九中,文章已经对模糊PID的实质做了一个简要说明.原本筹算比及完成结业设计,工作稳定了再着力完成剩下的部份.鉴于网友的要求和信任,抽出时间来,对模糊PID做一个较为详细的论述,这里我不筹算做出仿真法式了,但就基本概念和思路进行一下说明,相信有C语言基础的朋友可以通过这些介绍性的文字自行实现.这篇文章主要说明一下模糊算法的含义和原理.实际上模糊算法属于智能算法,智能算法也可以叫非模型算法,也就是说,当我们对系统的模型认识不是很深刻,或者说客观的原因招致我们无法对系统的控制模型进行深入研究的时候,智能算法经常能够起到不小的作用.这点是方便理解的,如果一个系统的模型可以轻易的获得,那么就可以根据系统的模型进行模型分析,设计出适合系统模型的控制器.可是现实世界中,可以说所有的系统都是非线性的,是不成预测的.但这其实不是说我们就无从建立控制器,因为,年夜部份的系统在一定的条件和范围内是可以笼统成为线性系统的.问题的关键是,当我们系统设计的范围超越了线性的范围,我们又该如何处置.显然,智能算法是一条很不错的途径.智能算法包括了专家系统、模糊算法、遗传算法、神经网络算法等.其实这其中的任何一种算法都可以跟PID去做结合,而选择的关键在于,处置的实时性能不能获得满足.当我们处置器的速度足够快速时,我们可以选择更为复杂的、精度更加高的算法.可是,控制器的处置速度限制了我们算法的选择.固然,本钱是限制处置器速度最根本的原因.这个事理很简单,51单片机和DSP的本钱肯定年夜不相同.专家PID和模糊PID是经常使用的两种PID选择方式.其实,模糊PID适应一般的控制系统是没有问题.文章接下来将说明模糊算法的一些基本知识.模糊算法其实其实不模糊.模糊算法其实也是逐次求精的过程.这里举个例子说明.我们设计一个倒立摆系统,假如摆针偏差<5°,我们说它的偏差比力“小”;摆针偏差在5°和10°之间,我们说它的偏差处于“中”的状态;当摆针偏差>10°的时候,我们说它的偏差有点儿“年夜”了.对“小”、“中”、“年夜”这样的辞汇来讲,他们是精确的表述,可问题是如果摆针偏差是3°呢,那么这是一种什么样的状态呢.我们可以用“很小”来表述它.如果是7°呢,可以说它是“中”偏“小”.那么如果到了80°呢,它的偏差可以说“非常年夜”.而我们调节的过程实际上就是让系统的偏差由非常“年夜”逐渐向非常“小”过度的过程.固然,我们系统这个调节过程是快速稳定的.通过上面的说明,可以认识到,其实对每一种状态都可以划分到年夜、中、小三个状态傍边去,只不外他们隶属的水平不太一样,比如6°隶属于小的水平可能是0.3,隶属于中的水平是0.7,隶属于年夜的水平是0.这里实际上是有一个问题的,就是这个隶属的水平怎么确定?这就要求我们去设计一个隶属函数.详细内容可以查阅相关的资料,这里没有法子那么详细的说明了.http://baike.百度.com/view/150383.htm(见附录3)这里面有些说明.那么,知道了隶属度的问题,就可以根据目前隶属的水平来控制机电以多年夜的速度和方向转动了,固然,最终的控制量肯定要落实在控制电压上.这点可以很容易的想想,我们控制的目的就是让倒立摆从隶属“年夜”的水平为1的状态,调节到隶属“小”的水平为1的状态.当隶属年夜多一些的时候,我们就加快调节的速度,当隶属小多一些的时候,我们就减慢调节的速度,进行微调.可问题是,年夜、中、小的状态是汉字,怎么用数字暗示,进而用法式代码暗示呢?其实我们可以给年夜、中、小三个状态设定三个数字来暗示,比如年夜暗示用3暗示,中用2暗示,小用1暗示.那么我们完全可以用1*0.3+2*0.7+3*0.0=1.7来暗示它,固然这个公式也纷歧定是这样的,这个公式的设计是系统模糊化和精确化的一个过程,读者也可拜会相关文献理解.但就1.7这个数字而言,可以说明,目前6°的角度偏差处于小和中之间,可是更偏向于中.我们就可以根据这个数字来调节机电的转动速度和时间了.固然,这个数字与机电转速的对应关系,也需要根据实际情况进行设计和调节.前面一个例子已经基本上说明了模糊算法的基来源根基理了.可是实际上,一个系统的限制因素经常不是一个.上面的例子中,只有偏差角度成了系统调节的参考因素.而实际系统中,比如PID系统,我们需要调节的是比例、积分、微分三个环节,那么这三个环节的作用就需要我们认清,也就是说,我们。
温度控制的增量式pid算法温度控制是工业生产中非常重要的一项技术,它可以保证生产过程中的温度稳定,从而保证产品的质量。
而PID算法是一种常用的控制算法,它可以根据当前的误差来调整控制器的输出,从而实现对温度的精确控制。
在本文中,我们将介绍一种基于增量式PID算法的温度控制方法。
增量式PID算法是一种常用的控制算法,它可以根据当前的误差和误差变化率来计算控制器的输出。
具体来说,增量式PID算法可以分为三个部分:比例控制、积分控制和微分控制。
比例控制是根据当前误差来计算控制器的输出,积分控制是根据误差的积分来计算控制器的输出,微分控制是根据误差的变化率来计算控制器的输出。
这三个部分的输出可以相加得到最终的控制器输出。
在温度控制中,我们可以将温度传感器的输出作为反馈信号,将设定温度作为目标信号,然后使用增量式PID算法来计算控制器的输出。
具体来说,我们可以将当前温度与设定温度的差值作为误差,将当前温度与上一次温度的差值作为误差变化率,然后使用增量式PID算法来计算控制器的输出。
控制器的输出可以通过控制加热器或冷却器的功率来实现对温度的控制。
需要注意的是,增量式PID算法需要对控制器的输出进行积分和微分,这可能会导致控制器的输出出现过冲或震荡的情况。
为了避免这种情况的发生,我们可以使用一些技巧来优化控制器的输出。
例如,我们可以使用限幅器来限制控制器的输出范围,或者使用滤波器来平滑控制器的输出。
增量式PID算法是一种非常有效的温度控制方法,它可以根据当前的误差和误差变化率来计算控制器的输出,从而实现对温度的精确控制。
在实际应用中,我们需要根据具体的情况来选择合适的控制参数,并使用一些技巧来优化控制器的输出,从而实现更加稳定和精确的温度控制。
PID控制原理和控制算法5.1 PID控制原理和程序流程5.1.1过程控制的基本概念过程控制――对生产过程的某一或某些物理参数进行的自动控制。
一、模拟控制系统图5-1-1 基本模拟反馈控制回路被控量的值由传感器或变送器来检测,这个值和给定值进行比较,得到偏差,模拟调节器依一定控制规律使操作变量变化,以使偏差趋近于零,其输出通过执行器作用于过程。
控制规律用对应的模拟硬件来实现,控制规律的修改需要更换模拟硬件。
二、微机过程控制系统图5-1-2 微机过程控制系统基本框图以微型计算机作为控制器。
控制规律的实现,是通过软件来完成的。
改变控制规律,只要改变相应的程序即可。
三、数字控制系统DDC图5-1-3 DDC系统构成框图DDC(Direct Digital Congtrol)系统是计算机用于过程控制的最典型的一种系统。
微型计算机通过过程输入通道对一个或多个物理量进行检测,并根据确定的控制规律(算法)进行计算,通过输出通道直接去控制执行机构,使各被控量达到预定的要求。
由于计算机的决策直接作用于过程,故称为直接数字控制。
DDC系统也是计算机在工业使用中最普遍的一种形式。
5.1.2 模拟PID调节器一、模拟PID控制系统组成图5-1-4 模拟PID 控制系统原理框图 二、模拟PID 调节器的微分方程和传输函数 PID 调节器是一种线性调节器,它将给定值r(t)和实际输出值c(t)的偏差的比例(P)、积分(I)、微分(D)通过线性组合构成控制量,对控制对象进行控制。
1、PID 调节器的微分方程⎥⎦⎤⎢⎣⎡++=⎰tDI P dt t de T dt t e T t e K t u 0)()(1)()( 式中 )()()(t c t r t e -= u ——调节器的输入信号;e ——测定值和给定值的差值; I T ——积分时间; D T ——微分时间; P K ——调节器放大倍数。
2、PID 调节器的传输函数 ⎥⎦⎤⎢⎣⎡++==S T S T K S E S U S D D I P 11)()()( 三、PID 调节器各校正环节的作用1、比例环节:即时成比例地反应控制系统的偏差信号e(t),偏差一旦产生,调节器立即产生控制作用以减小偏差。
PID控制算法的C语言实现一 PID算法原理最近两天在考虑一般控制算法的C语言实现问题,发现网络上尚没有一套完整的比较体系的讲解。
于是总结了几天,整理一套思路分享给大家。
在工业应用中PID及其衍生算法是应用最广泛的算法之一,是当之无愧的万能算法,如果能够熟练掌握PID算法的设计与实现过程,对于一般的研发人员来讲,应该是足够应对一般研发问题了,而难能可贵的是,在我所接触的控制算法当中,PID控制算法又是最简单,最能体现反馈思想的控制算法,可谓经典中的经典。
经典的未必是复杂的,经典的东西常常是简单的,而且是最简单的,想想牛顿的力学三大定律吧,想想爱因斯坦的质能方程吧,何等的简单!简单的不是原始的,简单的也不是落后的,简单到了美的程度。
先看看PID算法的一般形式:PID的流程简单到了不能再简单的程度,通过误差信号控制被控量,而控制器本身就是比例、积分、微分三个环节的加和。
这里我们规定(在t时刻):1.输入量为rin(t);2.输出量为rout(t);3.偏差量为err(t)=rin(t)-rout(t);pid的控制规律为理解一下这个公式,主要从下面几个问题着手,为了便于理解,把控制环境具体一下:1.规定这个流程是用来为直流电机调速的;2.输入量rin(t)为电机转速预定值;3.输出量rout(t)为电机转速实际值;4.执行器为直流电机;5.传感器为光电码盘,假设码盘为10线;6.直流电机采用PWM调速转速用单位转/min表示;不难看出以下结论:1.输入量rin(t)为电机转速预定值(转/min);2. 输出量rout(t)为电机转速实际值(转/min);3.偏差量为预定值和实际值之差(转/min);那么以下几个问题需要弄清楚:1.通过PID环节之后的U(t)是什么值呢?2.控制执行器(直流电机)转动转速应该为电压值(也就是PWM占空比)。
3.那么U(t)与PWM之间存在怎样的联系呢?/user1/3407/archives/2006/33541.html(见附录1)这篇文章上给出了一种方法,即,每个电压对应一个转速,电压和转速之间呈现线性关系。
增量式pid算法原理
增量式PID算法是一种用来控制反馈系统的算法,它可以根据系统的实时状态来调整PID的参数,从而实现控制系统对输入信号的快速、准确反应。
增量式PID算法的原理是根据当前状态和目标状态之间的误差,来产生一种调整控制器输出信号的方法。
它将控制器的输出信号看做是增量信号,即所需的调整量,而不是控制器的期望输出信号。
这样可以将PID算法的计算过程转化为增量形式,从而大大降低计算复杂度和运算量。
具体来说,增量式PID算法将PID算法的增量项(即KP、KI、KD的乘积)表示为一个变量Delta。
Delta的计算依赖于两个输入变量:当前的误差和上一次的误差。
根据这两个变量的差异,Delta用来调整控制器的输出信号,从而降低误差并实现更精确的控制。
通常情况下,增量式PID算法通过迭代计算来实现。
每次迭代中,控制器根据当前状态和目标状态之间的误差计算出Delta,根据Delta来调整控制器的输出信号,然后将新的输出信号作为反馈信号再次进行计算,直到误差减少到可接受的程度。
总的来说,增量式PID算法具有运算简单、输出可调节、控制精度高等优点,因此在自控系统中得到广泛应用。
增量式pid算法
增量式 PID 控制算法是一种改进的 PID 控制算法,它避免了
每次更新 PID 控制器输出时重新计算所有的控制参数。
该算
法将 PID 控制器的输出信号视为增量(差量)信号,即在前
一次控制信号基础上作出新的调整。
实现增量式 PID 算法的关键是保存前一次控制器的输出信号
以及相应的误差。
在每次控制周期内,首先根据当前的误差计算出 PID 控制器的增量部分,然后用前一次的控制信号加上
增量部分得到新的控制信号。
增量式 PID 算法的公式为:
Output(n) = Output(n-1) + Kp * (Error(n) - Error(n-1)) + Ki *
Error(n) + Kd * (Error(n) - 2 * Error(n-1) + Error(n-2))
其中,Output(n) 表示第 n 次控制的输出信号,Output(n-1) 表
示第n-1 次控制的输出信号,Error(n) 表示第n 次控制的误差,Error(n-1) 表示第 n-1 次控制的误差,Error(n-2) 表示第 n-2 次
控制的误差,Kp、Ki 和Kd 分别表示比例、积分和微分增益。
增量式 PID 算法的优点是可以减少计算量,提高控制器的响
应速度。
然而,由于增量式 PID 算法使用误差的差值计算增
量部分,因此对于系统初始状态的响应较慢。
此外,如果系统具有较大的噪声干扰或非线性特性,增量式 PID 算法可能出
现较大的误差累积。
因此,在实际应用中需要根据具体情况选择适当的 PID 控制算法。
增量式PID控制算法程序 ;********增量式PID控制算法程序*********** ;T、TD、TI、KP依次从30H,33H,36H,39H开始。 ;A,B,C的值依次存在BLOCK1,BLOCK2,BLOCK3的地址里 ; 这里R(k)给的是定值 ;
ORG 0000H BLOCK1 EQU 43H ;A,B ,C BLOCK2 EQU 46H BLOCK3 EQU 49H UK EQU 4CH ;存结果UK RK EQU 50H EK EQU 53H ;存放偏差值E(k)的始址 EK1 EQU 56H ;存放E(k-1)的始址 EK2 EQU 59H ;存放E(k-2)的始址 CK EQU 5CH ;采样数据始址 BUFF EQU 60H ;暂存区 BUFF1 EQU 63H BUFF2 EQU 66H REC EQU 69H TEST: MOV RK,#01H ;常数Rk的BCD码浮点数 MOV RK+1,#12H ;1.25 MOV RK+2,#50H MOV 3CH,#01H ;常数1的BCD码浮点数 MOV 3DH,#10H MOV 3EH,#00H MOV 40H,#01H ;常数2的BCD码浮点数 MOV 41H,#20H MOV 42H,#00H MOV 30H,#01H ;T的BCD 码浮点数 MOV 31H,#23H ;2.34 MOV 32H,#40H MOV 33H,#01H ;Td的BCD码浮点数 MOV 34H,#35H ;3.54 MOV 35H,#40H MOV 36H,#01H ;Ti的BCD码浮点数 MOV 37H,#11H ;1.12 MOV 38H,#20H MOV 39H,#01H ;Kp的BCD码浮点数 MOV 3AH,#12H ;1.25 MOV 3BH,#50H
MOV R0,#RK ;指向BCD码浮点操作数 LCALL BTOF ;将其转换成二进制浮点操作数 MOV R0,#3CH LCALL BTOF MOV R0,#40H LCALL BTOF
MOV R0,#39H LCALL BTOF MOV R0,#36H ;指向BCD码浮点操作数Ti LCALL BTOF ;将其转换成二进制浮点操作数 MOV R0,#33H ;指向BCD码浮点操作数Td LCALL BTOF ;将其转换成二进制浮点操作数 MOV R0,#30H ;指向BCD码浮点操作数T LCALL BTOF ;将其转换成二进制浮点操作数
MOV R1, #BUFF1 ;保存30H中的值 即T值 LCALL FMOVR0 MOV R1, #36H ;计算A值(1+T/Ti+Td/T).Kp LCALL FDIV MOV R1,#3CH ;常数1 LCALL FADD MOV R0,#33H ;保存33H中的值 MOV R1,#BUFF LCALL FMOVR0 MOV R1,#BUFF1 LCALL FDIV MOV R1,#30H ;30H里存的是T/Ti+1 LCALL FADD MOV R1,#39H LCALL FMUL MOV R1 ,#BLOCK1 ;将结果保存在BLOCK1中 LCALL FMOVR0 MOV R1,#BUFF1 ;30H恢复原值 MOV R0,#30H LCALL FMOV MOV R1,#BUFF ;33H恢复原值 MOV R0,#33H LCALL FMOV MOV R0,#40H ;计算B的值Kp.(1+2.Td/T) MOV R1,#33H LCALL FMUL MOV R1,#30H LCALL FDIV MOV R1,#3CH LCALL FADD MOV R1,#39H LCALL FMUL MOV R1,#BLOCK2 ;保存B值到BLOCK2中 LCALL FMOVR0 MOV R0,#39H ;计算C的值Kp.Td/T MOV R1,#33H LCALL FMUL MOV R1,#30H LCALL FDIV MOV R1,#BLOCK3 ;保存C值到BLOCK3中 LCALL FMOVR0 MOV R0,#EK1 ;将EK1,EK2设初值0 LCALL FCLR MOV R0,#EK2 LCALL FCLR MOV REC,#03H ;设置采样次数 LOOP: MOV CK,#7eH ;采样数据暂时给了一个定值 MOV CK+1,#21H ;0.002112 MOV CK+2,#12H MOV R0,#CK LCALL BTOF MOV R0,#RK ;保存R(k)中的值 MOV R1,#BUFF LCALL FMOVR0 MOV R1,#CK LCALL FSUB ;计算R(k)-C(k)的值送给E(k) MOV R1,#EK LCALL FMOVR0 MOV R1,#BUFF ;恢复RK的值 释放BUFF MOV R0,#RK LCALL FMOV MOV R0,#BLOCK2 ;将B.e(k-1)的值暂存在BUFF1中 MOV R1,#BUFF ;保存B LCALL FMOVR0 MOV R1,#EK1 LCALL FMUL MOV R1,#BUFF1 LCALL FMOVR0 MOV R1,#BUFF ;恢复B释放BUFF LCALL FMOV MOV R0,#BLOCK3 ;将C.e(K-2)的值暂存在BUFF2中 MOV R1,#BUFF ;保存C LCALL FMOVR0 MOV R1,#EK2 LCALL FMUL MOV R1,#BUFF2 LCALL FMOVR0 MOV R1,#BUFF ;恢复C释放BUFF LCALL FMOV MOV R0,#BLOCK1 ;A.E(k) MOV R1,#BUFF LCALL FMOVR0 MOV R1,#EK LCALL FMUL MOV R1,#BUFF1 ;计算Uk值A.E(k)-B.E(k-1)+C.E(k-2) LCALL FSUB MOV R1,#BUFF2 LCALL FADD MOV R1,#UK ;保存结果到UK中 LCALL FMOVR0 MOV R1,#BUFF ;恢复A 释放BUFF LCALL FMOV MOV R0,#UK ;UK转换成BCD码浮点数输出 LCALL FTOB MOV R1,#EK1 ;将E(k-1)-->E(k-2),E(k)-->E(k-1) MOV R0,#EK2 LCALL FMOV MOV R1,#EK MOV R0,#EK1 LCALL FMOV LCALL DELAY ;等待采样时刻 DJNZ REC,NEXT1 SJMP $ NEXT1: LJMP LOOP DELAY: MOV R7,#02H DELAY1: MOV R6,#0FFH DELAY2: DJNZ R6,DELAY2 DJNZ R7,DELAY1 RET
; (1) 标号: FSDT 功能:浮点数格式化 ;入口条件:待格式化浮点操作数在[R0]中。 ;出口信息:已格式化浮点操作数仍在[R0]中。 ;影响资源:PSW、A、R2、R3、R4、位1FH 堆栈需求: 6字节
FSDT: LCALL MVR0 ;将待格式化操作数传送到第一工作区中 LCALL RLN ;通过左规完成格式化 LJMP MOV0 ;将已格式化浮点操作数传回到[R0]中
; (2) 标号: FADD 功能:浮点数加法 ;入口条件:被加数在[R0]中,加数在[R1]中。 ;出口信息:OV=0时,和仍在[R0]中,OV=1时,溢出。 ;;影响资源:PSW、A、B、R2~R7、位1EH、1FH 堆栈需求: 6字节
FADD: CLR F0 ;设立加法标志 SJMP AS ;计算代数和 ; (3) 标号: FSUB 功能:浮点数减法 ;入口条件:被减数在[R0]中,减数在[R1]中。 ;出口信息:OV=0时,差仍在[R0]中,OV=1时,溢出。 ;影响资源:PSW、A、B、R2~R7、位1EH、1FH 堆栈需求:6字节
FSUB: SETB F0 ;设立减法标志 AS: LCALL MVR1 ;计算代数和。先将[R1]传送到第二工作区 MOV C,F0 ;用加减标志来校正第二操作数的有效符号 CLR A ; ********???应加的一条语句 RRC A XRL A,@R1 MOV C,ACC.7 ASN: MOV 1EH,C ;将第二操作数的有效符号存入位1EH中 XRL A,@R0 ;与第一操作数的符号比较 RLC A MOV F0,C ;保存比较结果 LCALL MVR0 ;将[R0]传送到第一工作区中 LCALL AS1 ;在工作寄存器中完成代数运算 MOV0: INC R0 ;将结果传回到[R0]中的子程序入口 INC R0 MOV A,R4 ;传回尾数的低字节 MOV @R0,A DEC R0 MOV A,R3 ;传回尾数的高字节