欧美极品高清xxxxhd,国产日产欧美最新,无码AV国产东京热AV无码,国产精品人与动性XXX,国产传媒亚洲综合一区二区,四库影院永久国产精品,毛片免费免费高清视频,福利所导航夜趣136

標(biāo)題: STM32單片機(jī)的PID算法實(shí)現(xiàn)程序無法編譯,求指導(dǎo) [打印本頁]
作者: 114786    時(shí)間: 2021-6-30 14:55
標(biāo)題: STM32單片機(jī)的PID算法實(shí)現(xiàn)程序無法編譯,求指導(dǎo)

  1. #include "System_init.h"
  2. extern int U_Set;
  3. extern u16 CCR1_Val;

  5. /*====================================================================================================
  6. PID Function
  7. The PID (比例、積分、微分) function is used in mainly
  8. control applications. PIDCalc performs one iteration of the PID
  9. algorithm.
  10. While the PID function works, main is just a dummy program showing
  11. a typical usage.
  12. =====================================================================================================*/
  13. typedef struct PID {
  14.         float SetPoint; // 設(shè)定目標(biāo)Desired value
  15.         float Proportion; // 比例常數(shù)Proportional Const
  16.         float Integral; // 積分常數(shù)Integral Const
  17.         float Derivative; // 微分常數(shù)Derivative Const
  18.         float LastError; // Error[-1]       
  19.         float PrevError; // Error[-2]
  20.         float SumError; // Sums of Errors
  21. } PID;
  22. /*====================================================================================================/
  23. PID計(jì)算部分
  24. =====================================================================================================*/
  25. PID   vPID={0,0.1,0.001,0.001,0,0,0};

  27. float PIDCalc( PID *pp, float NextPoint )
  28. {
  29.         float dError,
  30.         Error;
  31.         Error = pp->SetPoint - NextPoint; // 偏差
  32.         pp->SumError += Error; // 積分
  33.         dError = pp->LastError - pp->PrevError; // 當(dāng)前微分
  34.         pp->PrevError = pp->LastError;
  35.         pp->LastError = Error;

  37.     if(pp->SumError>900)  pp->SumError=900;
  38.     else if(pp->SumError<-900)          pp->SumError=-900;

  40.         return (pp->Proportion * Error // 比例項(xiàng)
  41.         + pp->Integral * pp->SumError // 積分項(xiàng)
  42.         + pp->Derivative * dError // 微分項(xiàng)
  43.         );
  44. }

  46. float Vol(int vSet,int v3){

  48.         float vOut; // PID Response (Output)
  49.         float vIn; // PID Feedback (Input)

  51.         vPID.SetPoint = vSet; // Set PID Setpoint
  52.         vIn = (float)v3; // Read Input
  53.         vOut = PIDCalc ( &vPID,vIn ); // Perform PID Interation         
  54.         return vOut;
  55. }

復(fù)制代碼

代碼: STM32單片機(jī)的PID算法實(shí)例.zip (729.66 KB, 下載次數(shù): 12)




歡迎光臨 (http://m.raoushi.com/bbs/) Powered by Discuz! X3.1