c语言pID程序怎么设计,51单片机PID的算法实现程序C语言
#include typedef unsigned char uint8;
typedef unsigned int uint16;
typedef unsigned long int uint32;
/函數(shù)聲明/
void PIDOutput ();
void PIDOperation ();
/*/
typedef struct PIDValue
{
uint32 Ek_Uint32[3]; //差值保存,給定和反饋的差值
uint8 EkFlag_Uint8[3]; //符號,1則對應(yīng)的為負(fù)數(shù),0為對應(yīng)的為正數(shù)
uint8 KP_Uint8;
uint8 KI_Uint8;
uint8 KD_Uint8;
uint16 Uk_Uint16; //上一時刻的控制電壓
uint16 RK_Uint16; //設(shè)定值
uint16 CK_Uint16; //實(shí)際值
}PIDValueStr;
PIDValueStr PID;
uint8 out ; // 加熱輸出
uint8 count; // 輸出時間單位計數(shù)器
/*
PID = Uk + KP*[E(k)-E(k-1)]+KI*E(k)+KD*[E(k)-2E(k-1)+E(k-2)];(增量型PID算式)
函數(shù)入口: RK(設(shè)定值),CK(實(shí)際值),KP,KI,KD
函數(shù)出口: U(K)
//PID運(yùn)算函數(shù)
/
void PIDOperation (void)
{
uint32 Temp[3]; //中間臨時變量
uint32 PostSum; //正數(shù)和
uint32 NegSum; //負(fù)數(shù)和
Temp[0] = 0;
Temp[1] = 0;
Temp[2] = 0;
PostSum = 0;
NegSum = 0;
if( PID.RK_Uint16 > PID.RK_Uint16 ) //設(shè)定值大于實(shí)際值否?
{
if( PID.RK_Uint16 - PID.RK_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)為正數(shù)
//數(shù)值移位
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)為正數(shù)
}
else
{
Temp[0]=PID.Ek_Uint32[0] - PID.Ek_Uint32[1]; //E(k)PID.EkFlag_Uint8[0]=1; //E(k)-E(k-1)為負(fù)數(shù)
}
//
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)為正數(shù)
}
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)為負(fù)數(shù)
}
//
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)]
/*以下部分代碼是講所有的正數(shù)項疊加,負(fù)數(shù)項疊加*/
/KP*[E(k)-E(k-1)]/
if(PID.EkFlag_Uint8[0]==0)
PostSum += Temp[0]; //正數(shù)和
else
NegSum += Temp[0]; //負(fù)數(shù)和
/* KI*E(k)/
if(PID.EkFlag_Uint8[1]==0)
PostSum += Temp[1]; //正數(shù)和
else
; //空操作,E(K)>0
/KD*[E(k-2)+E(k)-2E(k-1)]/
if(PID.EkFlag_Uint8[2]==0)
PostSum += Temp[2]; //正數(shù)和
else
NegSum += Temp[2]; //負(fù)數(shù)和
/*U(K)*/
PostSum += (uint32)PID.Uk_Uint16;
if(PostSum > NegSum ) // 是否控制量為正數(shù)
{
Temp[0] = PostSum - NegSum;
if( Temp[0] < 100 ) //小于上限幅值則為計算值輸出
PID.Uk_Uint16 = (uint16)Temp[0];
else
PID.Uk_Uint16 = 100; //否則為上限幅值輸出
}
else //控制量輸出為負(fù)數(shù),則輸出0(下限幅值輸出)
PID.Uk_Uint16 = 0;
}
}
else
{
PID.Uk_Uint16 = 0;
}
}
/*
函數(shù)入口: U(K)
函數(shù)出口: out(加熱輸出)
//PID運(yùn)算植輸出函數(shù)
/
void PIDOutput (void)
{
static int 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運(yùn)算一次
count=0;
i--;
}
}本文引用地址:http://www.eepw.com.cn/article/201611/318566.htm
總結(jié)
以上是生活随笔為你收集整理的c语言pID程序怎么设计,51单片机PID的算法实现程序C语言的全部內(nèi)容,希望文章能夠幫你解決所遇到的問題。
- 上一篇: linux安装创建逻辑卷,Linux系统
- 下一篇: Java 线程状态流转