PID算法（c 语言)（转）

PID算法（c 语言)（来自老外）

#include <stdio.h>
#include<math.h>

//定义PID 的结构体
struct _pid
{
  int pv;         // integer that contains the process value 过程量
  int sp;         // integer that contains the set point   设定值
  float integral; // 积分值 －－ 偏差累计值
  float pgain;
  float igain;
  float dgain;
  int deadband;   //死区
  int last_error;
};

struct _pid warm, *pid;
int process_point, set_point, dead_band;
float p_gain, i_gain, d_gain, integral_val, new_integ;

/*
 pid_init --- This function initializes the
 pointers  in  the  _pid  structure  to  the  process  variable
 and the setpoint. *pv and *sp are integer pointers.
 */

void pid_init( struct _pid *warm, int process_point, int set_point )
{
  struct _pid *pid;
  pid = warm;
  pid->pv = process_point;
  pid->sp = set_point;
}

/*pid_tune --- Sets the proportional gain (p_gain), integral gain (i_gain),
 derivitive  gain  (d_gain),  and  the  dead  band  (dead_band)
 of a pid control structure _pid.

 设定PID参数 －－－－ P,I,D,死区
 */

void pid_tune( struct _pid *pid,
  float p_gain,
  float i_gain,
  float d_gain,
  int dead_band )
{
  pid->pgain = p_gain;
  pid->igain = i_gain;
  pid->dgain = d_gain;
  pid->deadband = dead_band;
  pid->integral = integral_val;
  pid->last_error = ;
}

/*
 pid_setinteg --- Set a new value for the integral term of the pid equation.
 This is useful for setting the initial output of the pid controller at start up. 

 设定输出初始值
 */

void pid_setinteg( struct _pid *pid, float new_integ )
{
  pid->integral = new_integ;
  pid->last_error = ;
}

/*

 pid_bumpless --- Bumpless transfer  algorithim.
 When suddenly changing setpoints, or when restarting  the PID equation
 after an extended pause, the derivative of the equation can cause a bump
 in the controller output. This function will help smooth out  that bump.
 The process value in *pv should be the updated just before this function is used. 

 pid_bumpless 实现无扰切换
 当突然改变设定值时，或重新启动后，将引起扰动输出。这
 个函数将能实现平顺扰动， 在调用该函数之前需要先更新 PV值
 */

void pid_bumpless( struct _pid *pid )
{
  pid->last_error = ( pid->sp ) - ( pid->pv );  //设定值与反馈值偏差
}

/*
 pid_calc  ---  Performs  PID  calculations  for  the  _pid structure * a.
 This function uses the positional form of the pid
 equation, and incorporates an integral windup prevention algorithim.
 Rectangular  integration  is  used,  so  this  function  must
 be repeated on a consistent time basis for accurate  control.
 RETURN VALUE The new output value for the pid loop.  USAGE #include "control.h"
 本函数使用位置式PID计算方式，并且采取了积分饱和限制运算
 PID计算
 */

float pid_calc( struct _pid *pid )
{
  int err;
  float pterm, dterm, result, ferror;

  // 计算偏差
  err = ( pid->sp ) - ( pid->pv );

  // 判断是否大于死区
  if ( abs( err ) > pid->deadband )
  {
    ferror = (float) err;   //do integer to float conversion only once 数据类型转换 

    // 比例项
    pterm = pid->pgain * ferror;

    if ( pterm >  || pterm < - )
    {
      pid->integral = 0.0;
    }
    else
    {
      // 积分项
      pid->integral += pid->igain * ferror;

      // 输出为0－－100%
      // 如果计算结果大于100，则等于100
      if ( pid->integral > 100.0 )
      {
        pid->integral = 100.0;
      }
      // 如果计算结果小于0.0，则等于0
      else if ( pid->integral < 0.0 )
        pid->integral = 0.0;

    }

    // 微分项
    dterm = ( (float) ( err - pid->last_error ) ) * pid->dgain;

    result = pterm + pid->integral + dterm;
  }
  else
    result = pid->integral; // 在死区范围内，保持现有输出 

  // 保存上次偏差
  pid->last_error = err;

  // 输出PID值(0-100)
  return ( result );
}

void main( void )
{
  float display_value;
  int count = ;
  pid = &warm;

  // printf("Enter the values of Process point, Set point, P gain, I gain, D gain \n");
  // scanf("%d%d%f%f%f", &process_point, &set_point,&p_gain, &i_gain, &d_gain); 

  // 初始化参数
  process_point = ;
  set_point = ;
  p_gain = (float) ( 5.2 );
  i_gain = (float) ( 0.77 );
  d_gain = (float) ( 0.18 );
  dead_band = ;
  integral_val = (float) ( 0.01 );

  printf(    "The  values  of  Process  point,  Set  point,  P  gain, I gain, D gain \n" );
  printf( " %6d %6d %4f %4f %4f\n", process_point, set_point, p_gain, i_gain, d_gain );
  printf( "Enter the values of Process point\n" );
  while ( count <=  )
  {
    scanf( "%d", &process_point );

    // 设定PV,SP 值
    pid_init( &warm, process_point, set_point );

    // 初始化PID 参数值
    pid_tune( &warm, p_gain, i_gain, d_gain, dead_band );

    // 初始化PID 输出值
    pid_setinteg( &warm, 0.0 );

    //pid_setinteg(&warm,30.0);
    //Get input value for process point
    pid_bumpless( &warm );

    // how to display output
    display_value = pid_calc( &warm );

    printf( "%f\n", display_value );
    //printf("\n%f%f%f%f",warm.pv,warm.sp,warm.igain,warm.dgain); 

    count++;
  }
}