PID算法演示

ID:249033 · 發表于 2018-9-9 23:02

** ===================================================================
** SpeedPID
輸入：speedCount采集車速，AmSpeed 目標車速  ；
輸出：SpeedPWMOUT  計算車速；
** ===================================================================
*/
int16 SpeedControl(int16 speedCount,int16 AmSpeed,uint8 speedKP,uint8 speedKI,uint8 speedKD)
{



  *******************************************************************************************
//speedCount    檢測值
//AmSpeed       目標值
//speedKP       P
//speedKI       I
//speedKD          D

static float Speed1_Err,SumErrSpeed;  //靜態變量存儲中間變量
float Speed2_Err,Speed_EC;
float Speed_P_Value,Speed_D_Value ;

static int16  SpeedPWMOUT;

Speed2_Err = Speed1_Err ;             //將上一次的偏差保存(上一次的偏差值為0)

Speed1_Err = AmSpeed - speedCount  ;    //  計算新的偏差值（目標值-傳感器檢測值）



Speed_EC = Speed1_Err - Speed2_Err;    //  計算新的偏差變化值（上次的偏差值-上上次的偏差值）


Speed_P_Value =  Speed1_Err * speedKP/10.0 ; //  增量式PID控制計算P調節量

SumErrSpeed  +=  Speed1_Err * speedKI ; //增量式PID控制計算I調節量
Speed_D_Value =  Speed_EC *  speedKD/100.0 ;    //  增量式PID控制計算D調節量


SpeedPWMOUT += (int16)(Speed_P_Value + SumErrSpeed + Speed_D_Value);





//88888888888888888888888888888888 限幅       7777777777777777777777777777777
if(SpeedPWMOUT < SPEED_PWM_MIN )
{
   SpeedPWMOUT = SPEED_PWM_MIN ;
}
else if(SpeedPWMOUT > SPEED_PWM_MAX)
{
   SpeedPWMOUT = SPEED_PWM_MAX ;

}
if(SpeedPWMOUT<=0)SpeedPWMOUT=0;

//888888888888888888888888888888888    限幅    77777777777777676666777777777

return  SpeedPWMOUT ;
}

帳號		自動登錄	找回密碼
密碼			立即注冊

1024手机基地看电影,午夜福利视频导航,国产精品福利在线一区,亚洲欧美日韩另类成人,在线观看午夜日本理论片,成年超爽免费网站,国产精品成人免费,精品动作一级毛片,成人免费观看网站,97精品伊人久久大香蕉

PID算法演示