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

標題: Arduino通用PID函數 [打印本頁]

作者: kayjudas 時間: 2021-9-11 17:51
標題: Arduino通用PID函數
void setup() {

}

void loop() {

}
/********************************************************************
  函數名：void Init_PID_uint(PID_uint *p)
  功能：初始化PID參數
  說明：調用本函數之前，應該先對Kp,Ti,Td做設置       ,簡化了公式
  入口參數：PID單元的參數結構體地址
  返回值：無
***********************************************************************/
void Init_PID_uint(PID_Uint *p)
{
  p->k1 = (p->Kp) + (p->Kp) * 1024 / (p->Ti) + (p->Kp) * (p->Td) / 1024;
  p->k2 = (p->Kp) + 2 * (p->Kp) * (p->Td) / 1024;
  p->k3 = (p->Kp) * (p->Td) / 1024;
}
/********************************************************************
  函數名：void reset_Uk(PID_Uint *p)
  功能：初始化U_kk,ekk,ekkk
  說明：在初始化時調用，改變PID參數時有可能需要調用
  入口參數：PID單元的參數結構體地址
  返回值：無
***********************************************************************/
void reset_Uk(PID_Uint *p)
{
  p->U_kk = 0;
  p->ekk = 0;
  p->ekkk = 0;
}
/********************************************************************
  函數名：int PID_commen(int set,int jiance,PID_Uint *p)
  功能：通用PID函數
  說明：求任意單個PID的控制量
  入口參數：期望值，實測值，PID單元結構體
  返回值：PID控制量
***********************************************************************/
int PID_common(int set, int jiance, PID_Uint *p)
{
  int ek, U_k = 0;
  ek = jiance - set;
  if ((ek > (p->Un)) || (ek < -(p->Un)))       //積分不靈敏區
U_k = (p->U_kk) + (p->k1) * ek -
      (p->k2) * (p->ekk) + (p->k3) * (p->ekkk);
  p->U_kk = U_k;
  p->ekkk = p->ekk;
  p->ekk = ek;
  if (U_k > (p->Ur))                //限制最大輸出量，
U_k = p->Ur;
  if (U_k < -(p->Ur))
U_k = -(p->Ur);
  return U_k / 1024;
}

作者: iaskall 時間: 2021-10-25 10:54
這個不錯，可用于小車

作者: iwillw 時間: 2021-11-8 17:35
有自整定函數嗎？

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