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

標題: 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.denmoz.com/bbs/)