位置式PID控制器

[復(fù)制鏈接]

電梯直達(dá)

樓主

ID:211120 發(fā)表于 2017-6-14 13:34 | 只看該作者回帖獎(jiǎng)勵(lì)

|正序?yàn)g覽 |閱讀模式

/**************************************************************************
函數(shù)功能：位置式PID控制器
入口參數(shù)：編碼器測(cè)量位置信息，目標(biāo)位置
返回  值：電機(jī)PWM
說明：根據(jù)位置式離散PID公式: pwm=Kp*e(k)+Ki*∑e(k)+Kd[e（k）-e(k-1)]
e(k)代表本次偏差
e(k-1)代表上一次的偏差
∑e(k)代表e(k)以及之前的偏差的累積和;其中k為1,2,,k;
pwm代表輸出

**************************************************************************/
int16_t PID_Ctrl (int16_t Target_val,int16_t Actual_val )
{
Bias=Target_val-Actual_val;             // 計(jì)算偏差
Integral_bias+=Bias;                   // 求出偏差的積分

Pwm1 =Kp*Bias; //

Pwm2 =Ki*Integral_bias; //
if (Pwm2>=5600) Pwm2=5600;
else if(Pwm<=-5600) Pwm2=-5600;

// Pwm3 =Kd*(Bias-Last_Bias);    // 位置式PID控制器

Pwm =Kdim*(Pwm1+Pwm2) +1200;
// Pwm =Kdim*(Pwm1+Pwm2) +0x11a0;
Last_Bias=Bias;                            // 保存上一次偏差
return Pwm;                                  // 增量輸出
}

控制器, 編碼器, 測(cè)量, 電機(jī), 信息

分享到: QQ好友和群 QQ空間 騰訊微博 騰訊朋友

收藏0 淘帖0 頂0 踩0

帳號(hào)		自動(dòng)登錄	找回密碼
密碼			立即注冊(cè)

位置式PID控制器

相關(guān)帖子

瀏覽過的版塊