pid程序的應用

ID:365616 · 發表于 2018-7-5 14:57

typedef struct PID
{
int  SetPoint; //  設定目標 Desired Value
long SumError; // 誤差累計

double  Proportion;    //  比例常數 Proportional Const
double  Integral;    //  積分常數 Integral Const
double  Derivative;    //  微分常數 Derivative Const

int LastError;          //  Error[-1]
int PrevError;       //  Error[-2]

} PID;

static PID    sPID;
static PID    *sptr = &sPID;
//=============================================================
// Function: IncPIDInit()
// Syntax: void IncPIDInit(void);
// Description: Initialization PID parameter.
// Notes:
// parameters: none
// returns: none
//=============================================================
void PID_Init(void)
{
sptr->LastError  = 0; //Error[-1]
sptr->PrevError  = 0; //Error[-2]
sptr->Proportion = 0.3; //比例常數 Proportional Const
sptr->Integral = 0.2; //3.5積分常數 Integral Const
sptr->Derivative = 0.1; //1.25微分常數 Derivative Const
sptr->SetPoint = 0;
sptr->SumError = 0;
}

//=============================================================
// ----Function: IncPIDSetPoint()
// ------Syntax: void IncPIDSetPoint(unsigned int setpoint);
// -Description: Set PID Desired Value
// -------Notes:
// --parameters: Desired Value
// -----returns: none
//=============================================================
void PIDSetPoint(int setpoint)
{ sptr->SetPoint = setpoint; }

int PIDGetSetpoint(void)
{ return(sptr->SetPoint); }
//=============================================================
// ----Function: IncPIDKp()
// ------Syntax: void IncPIDKp(double dKp);
// -Description: Set PID Proportion coefficient
// -------Notes:
// --parameters: Proportion Const
// -----returns: none
//=============================================================
void PIDSetKp(double dKpp)
{ sptr->Proportion = dKpp; }
//===================================//
// Get Proportion
//===================================//
double PIDGetKp(void)
{ return(sptr->Proportion); }
//=============================================================
// ----Function: IncPIDKi()
// ------Syntax: void IncPIDKi(double dKi);
// -Description: Set PID Integral coefficient
// -------Notes:
// --parameters: Integral Const
// -----returns: none
//=============================================================
void PIDSetKi(double dKii)
{ sptr->Integral = dKii; }
//===================================//
// Get Integral
//===================================//
double PIDGetKi(void)
{ return(sptr->Integral); }
//=============================================================
// ----Function: IncPIDKd()
// ------Syntax: void IncPIDKd(double dKd);
// -Description: Set PID Derivative coefficient
// -------Notes:
// --parameters: Derivative Const
// -----returns: none
//=============================================================
void PIDSetKd(double dKdd)
{ sptr->Derivative = dKdd; }
//===================================//
// Get Derivative
//===================================//
double PIDGetKd(void)
{ return(sptr->Derivative); }

void Self_ConfigPID(double uiKp)
{
double dKp;
dKp = uiKp;
PIDSetKp(2.45*dKp);
PIDSetKi(3.50*dKp);
PIDSetKd(1.25*dKp);
}

//=============================================================
// ----Function: IncPIDCalc()
// ------Syntax: int IncPIDCalc(unsigned int NextPoint);
// -Description: Increment Digital PID calculate
// -------Notes: Basic Increment Digital PID
// --parameters: Next Point
// -----returns: increase controls parameter
//=============================================================
int IncPIDCalc(int NextPoint)
{
register int iError, iIncpid;

iError = sptr->SetPoint - NextPoint;

iIncpid = sptr->Proportion * iError //E[0]
         + sptr->Integral * sptr->LastError //E[-1]
         + sptr->Derivative * sptr->PrevError; //E[-2]

sptr->PrevError = sptr->LastError;
sptr->LastError = iError;

return(iIncpid);
}

//=============================================================
// ----Function: LocPIDCalc()
// ------Syntax: unsigned int locPIDCalc(unsigned int NextPoint);
// -Description: Location Digital PID calculate
// -------Notes: Basic Location Digital PID
// --parameters: Next Point
// -----returns: Location controls parameter
//=============================================================
unsigned int LocPIDCalc(int NextPoint)
{
register int  iError,dError;

iError = sptr->SetPoint - NextPoint;       // 偏差
sptr->SumError += iError; // 積分
dError = iError - sptr->LastError; // 當前微分
sptr->LastError = iError;

return(sptr->Proportion * iError            // 比例項
         + sptr->Integral * sptr->SumError // 積分項
         + sptr->Derivative * dError);
}

//=============================================//
// *END*
//=============================================//

帳號		自動登錄	找回密碼
密碼			立即注冊

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

pid程序的應用

評分

瀏覽過的版塊

	沙發無效樓層，該帖已經被刪除