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

標題: 簡單的pid函數 [打印本頁]

作者: 大哥大雷神 時間: 2016-9-11 14:39
標題: 簡單的pid函數
float PID(float e,float kp,float ki,float kd)
{
      static float e_s=0,sum=0;//e_s用于保存上一次的誤差值，用于計算微分項。Sum用于計算累加和，計算積分項。
      float r;
      sum+=e;//計算積分累加和
      r=kp*e+ki*sum+kd*(e-e_s);//從左至右分別是比例項、積分項、微分項
      e_s=e;//保存這一次的誤差值用于下一次微分計算
      return r;
}

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