位置式PID算法的C语言代码

最新推荐文章于 2025-11-06 00:15:00 发布

原创最新推荐文章于 2025-11-06 00:15:00 发布 · 1.2w 阅读

32 ·

CC 4.0 BY-SA版权

c语言专栏收录该内容

4 篇文章

订阅专栏

本文深入探讨了PID控制器的工作原理，包括误差计算、积分、微分等关键步骤，并详细介绍了如何进行输出限幅以确保系统稳定性和响应速度。通过实例演示，展示了PID控制器在实际应用中的优化方法。

typedef struct{
	float limit;	//输出限幅
	float target;	//目标量
	float feedback;	//反馈量
	float Kp;		
	float Ki;
	float Kd;
	float eSum;
	float e0;		//当前误差
	float e1;		//上一次误差
}PIDType;

#define max(a, b)			(a>b? a:b)
#define min(a, b)			(a<b? a:b)
#define range(x, a, b)		(min(max(x, a), b))

float pid_pos_update(PIDType *p)
{
	float pe, ie, de;
	float out=0;

	//计算当前误差
	p->e0 = p->target - p->feedback;

	//误差积分
	p->eSum += p->e0;

	//误差微分
	de = p->e0 - p->e1;

	pe = p->e0;
	ie = p->eSum;

	p->e1 = p->e0;

	out = pe*(p->Kp) + ie*(p->Ki) + de*(p->Kd);
	//输出限幅
	out = range(out, -p->limit, p->limit);
	return out;
}