PID-小車類-手機遙控十分mimi藍牙小車V2資料全部開源/**************************************************************************函數功能：增量PI控制器入口參數：編碼器測量值，目標速度返回 值：電機PWM根據增量式離散PID公式 pwm+=Kp[e（k）-e(k-1)]+Ki*e(k)+Kd[e(k)-2e(k-1)+e(k-2)]e(k)代表本次偏差 e(k-1)代表上一次的偏差 以此類推 pwm代表增量輸出在我們的速度控制閉環系統里面，只使用PI控制pwm+=Kp[e（k）-e(k-1)]+Ki*e(k)**************************************************************************/int Speed_Incremental_PI (int Encoder,int Target){ static int Bias,Pwm,Last_bias; Bias=Encoder-Target; //計算偏差 Pwm+=Speed_Kp*(Bias-Last_bias)+Speed_Ki*Bias; //增量式PI控制器if(Pwm>500)Pwm=500;else if(Pwm<-500)Pwm=-500; Last_bias=Bias; //保存上一次偏差 return Pwm; //增量輸出}
標簽：
pid
藍牙小車
上傳時間：
2022-06-01
上傳用戶：20125101110
