亚洲春色中文字幕久久久-三上亚,一吻二脱三床四吻胸,国产真实伦对白视频全集,在线毛片观看,精品成品入口黄网,国产毛aⅴ片久久久,亚洲AV色香蕉一区二区三区老师,萧皇后A级艳片,色情日本视频更新,99久久亚洲精品日本无码

標題: PID增量式位置式代碼 [打印本頁]

作者: RMLS 時間: 2019-6-11 08:57
標題: PID增量式位置式代碼
//位置式PID
int32 PID_Realize(PID *sptr, float *PID, int32 NowData, int32 Point)
{
int32 iError, // 當前誤差
Realize; // 最后得出的實際增量
iError = Point - NowData; //計算當前誤差
sptr->SumError += PID[KI] * iError; //誤差積分
if (sptr->SumError >= PID[KT])
{
  sptr->SumError = PID[KT];
}
else if (sptr->SumError <= -PID[KT])
{
  sptr->SumError = -PID[KT];
}
Realize = PID[KP] * iError
+ sptr->SumError
+ PID[KD] * (iError - sptr->LastError)*100;
sptr->PrevError = sptr->LastError; // 更新前次誤差
sptr->LastError = iError;    // 更新上次誤差
sptr->LastData  = NowData; // 更新上次數(shù)據(jù)
return Realize; // 返回實際值
}
//增量式PID
int32 PID_Increase(PID *sptr, float *PID, int32 NowData, int32 Point)
{
int32 iError, //當前誤差
  Increase; //最后得出的實際增量
iError = Point - NowData; // 計算當前誤差
Increase =  PID[KP] * (iError - sptr->LastError)
   + PID[KI] * iError
   + PID[KD] * (iError - 2 * sptr->LastError + sptr->PrevError);

sptr->PrevError = sptr->LastError; // 更新前次誤差
sptr->LastError = iError;    // 更新上次誤差
sptr->LastData  = NowData; // 更新上次數(shù)據(jù)
return Increase; // 返回增量
}

歡迎光臨 (http://www.denmoz.com/bbs/)