pid.c

来自「uCos应用」· C语言 代码 · 共 60 行

/****************************************Copyright (c)**************************************************
**                               Guangzhou ZHIYUAN electronics Co.,LTD.
**                                     
**                                 http://www.embedtools.com
**
**--------------File Info-------------------------------------------------------------------------------
** File Name:          Pid.c
** Last modified Date: 2006-11-18
** Last Version:       v1.0
** Description:        PID增量式算法
** 
**------------------------------------------------------------------------------------------------------
** Created By:         Zhou Shaogang
** Created date:       2006-11-18
** Version:            v1.0
** Descriptions:
**
**------------------------------------------------------------------------------------------------------
** Modified by:
** Modified date:
** Version:
** Description:
**
********************************************************************************************************/

#include <includes.h>

int32 Ka_PC=(int32)(Ka*100);      
int32 Kb_PC=(int32)(Kb*100);
int32 Kc_PC=(int32)(Kc*100);

/************************************************************************************
** Function name: PID_DltDuty
** Descriptions:  增量式PID算法
** Input:         E: 偏差值
** Output:        PWM占空比的脉冲数
** Created by:    Zhou Shaogang
** Created Date:  2006-11-18
**----------------------------------------------------------------------------------
** Modified by:
** Modified Date: 
**----------------------------------------------------------------------------------
************************************************************************************/
int32 PID_DltDutyCycle(int32 E)
{
  static int32 Ek=0;
  static int32 Ek_1=0;
  static int32 Ek_2=0;

  Ek_2=Ek_1;                           
  Ek_1=Ek;
  Ek=E;
  
 #if PID_PC_CONST_EN
  return( (int32) ((Ka_PC*Ek + Kb_PC*Ek_1 +Kc_PC*Ek_2)*0.01*Cal_Const) );
 #else
  return( (int32) (Ka*Ek + Kb*Ek_1 +Kc*Ek_2) );    
 #endif
}