用整型变量来完成PID算法,由所以用整型数来做的,所以也不是很准确,可是关于许多的运用场合,这个精度也够了,关于系数和采样电压全部是扩大10倍处理的.所以精度不是很高. 可是也不是那么低,大部分的场合都够了. 真实觉得精度不行, 能够再扩大10倍或许100倍处理,可是要注意不超出整个数据类型的规模就能够了.本程序包含PID核算和输出两部分.当误差>10度全速加热,误差在10度以内为PID核算输出.详细的参阅代码拜见下面:*/
//================================================================
// pid.H
// Operation about PID algorithm procedure
// C51编译器Keil 7.08
//================================================================
// 作者:zhoufeng
// Date :2007-08-06
// All rights reserved.
//================================================================
#include
#include
typedefunsignedcharuint8;
typedefunsignedintuint16;
typedefunsignedlong intuint32;
voidPIDOutput ();
voidPIDOperation ();
typedef struct PIDValue
{
uint32Ek_Uint32[3];//差值保存,给定和反应的差值
uint8EkFlag_Uint8[3];//符号,1则对应的为负数,0为对应的为正数
uint8KP_Uint8;
uint8KI_Uint8;
uint8KD_Uint8;
uint16Uk_Uint16;//上一时刻的操控电压
uint16RK_Uint16;//设定值
uint16CK_Uint16;//实践值
}PIDValueStr;
PIDValueStrPID;
uint8out ;// 加热输出
uint8count;// 输出时刻单位计数器
voidPIDOperation (void)
{
uint32Temp[3];//中心暂时变量
uint32PostSum;//正数和
uint32NegSum;//负数和
Temp[0] = 0;
Temp[1] = 0;
Temp[2] = 0;
PostSum = 0;
NegSum= 0;
if( PID.RK_Uint16 > PID.CK_Uint16 )//设定值大于实践值否?
{
if( PID.RK_Uint16 – PID.CK_Uint16 >10 )//误差大于10否?
{
PID.Uk_Uint16 = 100;}//误差大于10为上限幅值输出(全速加热)
else
{
Temp[0] = PID.RK_Uint16 – PID.CK_Uint16;//误差<=10,核算E(k)
PID.EkFlag_Uint8[1]=0;//E(k)为正数
//数值移位
PID.Ek_Uint32[2] = PID.Ek_Uint32[1];
PID.Ek_Uint32[1] = PID.Ek_Uint32[0];
PID.Ek_Uint32[0] = Temp[0];
if( PID.Ek_Uint32[0] >PID.Ek_Uint32[1] )//E(k)>E(k-1)否?
{
Temp[0]=PID.Ek_Uint32[0] – PID.Ek_Uint32[1];//E(k)>E(k-1)
PID.EkFlag_Uint8[0]=0;}//E(k)-E(k-1)为正数
else
{
Temp[0]=PID.Ek_Uint32[0] – PID.Ek_Uint32[1];//E(k)PID.EkFlag_Uint8[0]=1;}//E(k)-E(k-1)为负数
Temp[2]=PID.Ek_Uint32[1]*2 ;// 2E(k-1)
if( (PID.Ek_Uint32[0] PID.Ek_Uint32[2])>Temp[2] )//E(k-2) E(k)>2E(k-1)否?
{
Temp[2]=(PID.Ek_Uint32[0] PID.Ek_Uint32[2])-Temp[2];//E(k-2) E(k)>2E(k-1)
PID.EkFlag_Uint8[2]=0;}//E(k-2) E(k)-2E(k-1)为正数
else
{
Temp[2]=Temp[2]-(PID.Ek_Uint32[0] PID.Ek_Uint32[2]);//E(k-2) E(k)<2E(k-1)
PID.EkFlag_Uint8[2]=1;}//E(k-2) E(k)-2E(k-1)为负数
Temp[0] = (uint32)PID.KP_Uint8 * Temp[0];// KP*[E(k)-E(k-1)]
Temp[1] = (uint32)PID.KI_Uint8 * PID.Ek_Uint32[0];// KI*E(k)
Temp[2] = (uint32)PID.KD_Uint8 * Temp[2];// KD*[E(k-2) E(k)-2E(k-1)]
if(PID.EkFlag_Uint8[0]==0)
PostSum = Temp[0];//正数和
else
NegSum = Temp[0];//负数和
if(PID.EkFlag_Uint8[1]==0)
PostSum = Temp[1];//正数和
else
;//空操作,E(K)>0
if(PID.EkFlag_Uint8[2]==0)
PostSum = Temp[2];//正数和
else
NegSum = Temp[2];//负数和
PostSum = (uint32)PID.Uk_Uint16;
if(PostSum > NegSum )// 是否操控量为正数
{ Temp[0] = PostSum – NegSum;
if( Temp[0] < 100 )//小于上限幅值则为核算值输出
PID.Uk_Uint16 = (uint16)Temp[0];
else
PID.Uk_Uint16 = 100;//否则为上限幅值输出
}
else//操控量输出为负数,则输出0(下限幅值输出)
PID.Uk_Uint16 = 0;
}
}
else
{ PID.Uk_Uint16 = 0;}
}
voidPIDOutput (void)
{
staticint i;
i=PID.Uk_Uint16;
if(i==0)
out=1;
else out=0;
if((count )==5)//如守时中止为40MS,40MS*5=0.2S(输出时刻单位),加热周期20S(100等份)
{//每20S PID运算一次
count=0;
i–;
}
}
声明:本文内容来自网络转载或用户投稿,文章版权归原作者和原出处所有。文中观点,不代表本站立场。若有侵权请联系本站删除(kf@86ic.com)https://www.86ic.net/ceping/258275.html