a一级爱做片免费观看欧美,久久国产一区二区,日本一二三区免费,久草视频手机在线观看

新聞中心

EEPW首頁 > 嵌入式系統 > 設計應用 > C51如何實現帶死區控制的PID算法

C51如何實現帶死區控制的PID算法

作者: 時間:2011-09-10 來源:網絡 收藏
真正要用的時候,發現書上的代碼在我們51上來實現還不是那么容易的事情。簡單的說來,就是不能直接調用。仔細分析你可以發現,教材上的、網上現行的PID實現的C語言代碼幾乎都是用浮點型的數據來做的,可以想象,如果我們的計算使用浮點數據,那我們的51單片機來運行的話會有多痛苦。

所以,本人自己琢磨著弄了一個整型變量來實現了,由于是用整型數來做的,所以也不是很精確,但是對于很多的使用場合,這個精度也夠了。關于系數和采樣電壓全部是放大10倍處理的。所以精度不是很高,但是也不是那么低,大部分的場合都夠用了。實在覺得精度不夠,可以再放大10倍或者100倍處理,但是要注意不超出整個數據類型的范圍就可以了。

本人做的是帶死區控制的

具體的參考代碼參見下面:
typedefstructPIDValue
{
uint32Ek_Uint32[3];//差值保存,給定和反饋的差值
uint8EkFlag_Uint8[3];//符號,1則對應的Ek[i]為負數,0為對應的Ek[i]為正數
uint8KP_Uint8;
uint8KI_Uint8;
uint8KD_Uint8;
uint8B_Uint8;//死區電壓

uint8KP;//顯示修改的時候用
uint8KI;//
uint8KD;//
uint8B;//
uint16Uk_Uint16;//上一時刻的控制電壓
}PIDValueStr;

PIDValueStrxdataPID;
/*******************************
**PID=Uk+(KP*E(k)-KI*E(k-1)+KD*E(k-2));
********************************/
voidPIDProcess(void)
{
uint32idataTemp[3];//
uint32idataPostSum;//正數和
uint32idataNegSum;//負數和
Temp[0]=0;
Temp[1]=0;
Temp[2]=0;
PostSum=0;
NegSum=0;
if(ADPool.Value_Uint16[UINADCH]>ADPool.Value_Uint16[UFADCH])//給定大于反饋,則EK為正數
{
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*EK0
Temp[1]=(uint32)PID.KI_Uint8*PID.Ek_Uint32[1];//KI*EK1
Temp[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*EK0
Temp[1]=(uint32)PID.KI_Uint8*PID.Ek_Uint32[1];//KI*EK1
Temp[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*EK0
if(PID.EkFlag_Uint8[1]!=0)
{
PostSum+=Temp[1];//正數和
}
else
{
NegSum+=Temp[1];//負數和
}//-kI*EK1
if(PID.EkFlag_Uint8[2]==0)
{
PostSum+=Temp[2];//正數和
}
else
{
NegSum+=Temp[2];//負數和
}//KD*EK2
PostSum+=(uint32)PID.Uk_Uint16;//
if(PostSum>NegSum)//是否控制量為正數
{
Temp[0]=PostSum-NegSum;
if(Temp[0](uint32)ADPool.Value_Uint16[UMAXADCH])//小于限幅值則為計算值輸出
{
PID.Uk_Uint16=(uint16)Temp[0];
}
else
{
PID.Uk_Uint16=ADPool.Value_Uint16[UMAXADCH];//否則為限幅值輸出
}
}
else//控制量輸出為負數,則輸出0
{
PID.Uk_Uint16=0;
}
}

pid控制相關文章:pid控制原理


pid控制器相關文章:pid控制器原理




關鍵詞: C51 PID算法

評論


相關推薦

技術專區

關閉