增量式PID控制C语言代码

增量式PID控制C语言代码

增量式PID控制公式：

上面△u(k)是控制量增量，“增量式PID”就是直接以这个增量进行控制。

至于参数的整定，根据响应的情况调，比如，响应慢了，我就增大kp，或者减小kd，超调大了，就减小kp或增大点kd，这个规律你可以看看PID三个参数的作用：）

// 定义PID参数结构体

///

typedef struct PID {              //结构体定义

        int  SetPoint            //设定值

        int  Proportion;         // Proportion 比例系数

        int  Integral;            // Integral   积分系数

        int  Derivative;          // Derivative  微分系数

        int  LastError;          // Error[-1]  前一拍误差

        int  PreError;           // Error[-2]  前两拍误差

} PID;

main()

{

  PID vPID;                        //定义结构变量名

PIDInit ( &vPID );                 //Initialize Structure

vPID.Proportion = 10;             //Set PID Coefficients  

  vPID.Integral   = 10;             // Set PID Integral

  vPID.Derivative = 10;             // Set PID Derivative

  vPID. SetPoint =                 //根据实际情况设定

  while(1)

{

       Verror=Measure();               //得到AD的输出值

       Error =vPID. SetPoint- Verror;   //与设定值比较，得到误差值

tempi=PIDCal(&vPID, Error;

       laser.Value+=tempi;          // Value与Num[2]为共同体，共同体名laser

LASERH=laser.Num[0];

LASERL=laser.Num[1];

  }

}

///

//Title:PID参数初始化

//Description: Proportion="0"

//           Integral=0

//           LastError=0

//Input: PID的P、I控制常数和之前的误差量（PID *pp）

//Return:

//

void PIDInit (PID *pp)                     //PID参数初始化，都置0

   {                                           

     memset ( pp,0,sizeof(PID));

//memset()的函数， 它可以一字节一字节地把整个数组设置为一个指定的值。

// memset()函数在mem.h头文件中声明，它把数组的起始地址作为其第一个参数，

//第二个参数是设置数组每个字节的值，第三个参数是数组的长度(字节数，不是元素个数)。

//其函数原型为：　void *memset(void*，int，unsigned)；

//头文件<string.h>

   }

///

//Title:增量式PID算法程序

//Description:给出一个误差增量

//Input: PID的P、I控制常数和之前的误差量（PID *pp）& 当前误差量（ThisError）

//Return: 误差增量templ

//

int PIDCal( PID *pp, int ThisError ){

//增量式PID算法（需要控制的不是控制量的绝对值，而是控制量的增量）

    int pError,dError,iError;

long templ;

    pError = ThisError-pp->LastError;

    iError = ThisError;

    dError = ThisError-2*(pp->LastError)+pp->PreError;

//增量计算

    templ=pp->Proportion*pError + pp->Integral*iError+pp->Derivative*dError;  //增量

    //存储误差用于下次运算

    pp->PreError  = pp->LastError;

    pp->LastError = ThisError;

    return ((int)(templ>>8));

}

参考自：http://blog.sina.com.cn/s/blog_408540af0100asu3.html