数字PI控制器

最新推荐文章于 2024-04-28 22:19:20 发布

yf夜风

最新推荐文章于 2024-04-28 22:19:20 发布

阅读量1.4w

点赞数 8

分类专栏： C/C++ 文章标签： PI算法 c语言数字PI控制器

本文链接：https://blog.csdn.net/Wind4study/article/details/45116281

版权

C/C++ 专栏收录该内容

3 篇文章 1 订阅

订阅专栏

最近项目需要用到PI控制器，于是参考网上的一些资料，尝试着写了一下，将它记录下来以备后用。

PID公式：

Ti，Td分别为积分，微分常数，只取PI部分：

根据采样周期T离散化，t=nT,用n表示，

可得增量式：

分别为比例，积分系数

为计算系数

最终输出为：

写代码时，定义一个结构体来存放各个参数，

程序设计流程为：

本次采样输入→计算本次误差→计算输出增量→更新数据为下次做准备

附源码：

/************声明和定义，通常放在头文件中********/
typedef struct
{
	int SetValue;        //设置值
	int An;			//当前误差e(n)的系数，=kp+ki
	int Bn_1;			//前一项误差e(n-1)的系数，= -kp
	int Limit;			//限制最大最小值
	int Errorn_1;		//e(n-1)
	int DeltaUn;		//输出增量△u(n);
	int Un_output;	//输出值 u(n)
}PI_Typedef;

void PI_StructInit(PI_Typedef *PI_Struct,int Kp,int Ki,int limit);
void PI_Controller(PI_Typedef *PI_Struct,int NewInput,int *Output);
/*****************************************************************/


void PI_StructInit(PI_Typedef *PI_Struct,int Kp,int Ki,int limit)
{
	PI_Struct->SetValue = 0;
	PI_Struct->An = Kp+Ki;
	PI_Struct->Bn_1 = -Kp;
	PI_Struct->Limit = limit;
	PI_Struct->DeltaUn = 0;
	PI_Struct->Errorn_1 = 0;
}

void PI_Controller(PI_Typedef *PI_Struct,int NewInput,int *Output)
{
	int Errorn =0;

	Errorn = PI_Struct->SetValue - NewInput;//计算e(n)

	PI_Struct->DeltaUn = (PI_Struct->An)*Errorn+(PI_Struct->Bn_1)*(PI_Struct->Errorn_1);//计算增量
	PI_Struct->Errorn_1 = Errorn;//保存误差e(n)作为下一次计算的e(n-1)
	//限制增量的范围
	if(PI_Struct->DeltaUn > PI_Struct->Limit)
		{PI_Struct->DeltaUn = PI_Struct->Limit;}
	else if(PI_Struct->DeltaUn < -PI_Struct->Limit)
		{PI_Struct->DeltaUn = -PI_Struct->Limit;}

	PI_Struct->Un_output += PI_Struct->DeltaUn; //计算输出u(n)=u(n-1)+△u(n),并保存作下一次运算

	*Output = PI_Struct->Un_output;
}