《電子技術應用》
您所在的位置:首頁 > 通信與網絡 > 設計應用 > C51如何實現帶死區控制的PID算法
C51如何實現帶死區控制的PID算法
EEworld
EEworld
摘要: 真正要用PID算法的時候,發現書上的代碼在我們51上來實現還不是那么容易的事情。簡單的說來,就是不能直接調用...
關鍵詞: C51 PID算法
Abstract:
Key words :

關鍵字:C51 PID算法

真正要用PID算法的時候,發現書上的代碼在我們51上來實現還不是那么容易的事情。簡單的說來,就是不能直接調用。仔細分析你可以發現,教材上的、網上現行的PID實現的C語言代碼幾乎都是用浮點型的數據來做的,可以想象,如果我們的計算使用浮點數據,那我們的51單片機來運行的話會有多痛苦。
 
所以,本人自己琢磨著弄了一個整型變量來實現了PID算法,由于是用整型數來做的,所以也不是很精確,但是對于很多的使用場合,這個精度也夠了。關于系數和采樣電壓全部是放大10倍處理的。所以精度不是很高,但是也不是那么低,大部分的場合都夠用了。實在覺得精度不夠,可以再放大10倍或者100倍處理,但是要注意不超出整個數據類型的范圍就可以了。
 
本人做的是帶死區控制的PID算法。
 
具體的參考代碼參見下面:
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] )  //給定大于反饋,則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;
    }
}
此內容為AET網站原創,未經授權禁止轉載。
主站蜘蛛池模板: www.免费在线观看| 四虎国产精品永久免费网址| 两性色午夜视频免费网| 欧美性69式xxxx护士| 四虎精品视频在线永久免费观看| 91精品国产麻豆福利在线| 日产2021乱码一区| 人妻体体内射精一区二区| 国产精品综合在线| 在线天堂中文官网| 天天躁日日躁狠狠躁一级毛片 | www日本xxx| 韩国久播影院理论片不卡影院| 小四郎在线观看| 久久青青草原亚洲av无码麻豆| 狼群影院www| 国产gay小鲜肉| 日本免费网站视频www区| 天天做天天爱天天爽综合网| 久久久久成人精品免费播放动漫| 美女高清特黄a大片| 国产精品久久久久影院免费| 一区二区三区国产最好的精华液| 最新欧美精品一区二区三区| 人人妻人人澡人人爽精品欧美| 色婷婷久久综合中文久久蜜桃| 国产精品久久久久9999高清| www亚洲视频| 日本www.色| 亚洲AV色香蕉一区二区三区蜜桃| 波多野结衣系列电影在线观看| 哒哒哒免费视频观看在线www | 99爱在线视频| 少妇激情av一区二区| 久久久久久夜精品精品免费啦| 最近的免费中文字幕视频| 亚洲日韩国产成网在线观看| 激情国产AV做激情国产爱| 免费观看我爱你电影| 美女叉开腿让男人捅| 国产一区二区精品久久岳|