色婷婷AⅤ一区二区三区|亚洲精品第一国产综合亚AV|久久精品官方网视频|日本28视频香蕉

          新聞中心

          EEPW首頁 > 嵌入式系統(tǒng) > 設計應用 > C51實現(xiàn)PID算法代碼

          C51實現(xiàn)PID算法代碼

          作者: 時間:2012-03-25 來源:網(wǎng)絡 收藏

          真正要用的時候,發(fā)現(xiàn)書上的在我們51上來還不是那么容易的事情。簡單的說來,就是不能直接調用。仔細分析你可以發(fā)現(xiàn),教材上的、網(wǎng)上現(xiàn)行的的C語言幾乎都是用浮點型的數(shù)據(jù)來做的,可以想象,如果我們的計算使用浮點數(shù)據(jù),那我們的51單片機來運行的話會有多痛苦。

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

          本人做的是帶死區(qū)控制的PID。

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

          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;//正數(shù)和
          uint32idataNegSum;//負數(shù)和
          Temp[0]=0;
          Temp[1]=0;
          Temp[2]=0;
          PostSum=0;
          NegSum=0;
          if(ADPool.Value_Uint16[UINADCH]>ADPool.Value_Uint16[UFADCH])//給定大于反饋,則EK為正數(shù)
          {
          Temp[0]=ADPool.Value_Uint16[UINADCH]-ADPool.Value_Uint16[UFADCH];//計算Ek[0]
          if(Temp[0]>PID.B_Uint8)
          {
          //數(shù)值移位
          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為正數(shù)
          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)
          {
          //數(shù)值移位
          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為負數(shù)
          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
          }
          }


          上一頁 1 2 下一頁

          評論


          相關推薦

          技術專區(qū)

          關閉