PID控制输出PWM核心代码(基于STM32F103)

注:

1、如果对于PID控制原理不是很了解,可以找些资料看,最好先搞懂原理。

2、程序中Kp、Ki、Kd、199.0可根据实际情况自己修改。

//全局变量
float target=30.0;//目标温度
float error_all=0;
unsigned int show_zkb=0;//这是一个整数,即当前占空比,可用于在屏幕上显示


//PID算法
int PID(float input_wendu)//反馈输入温度,从温度传感器上读取,如DHT11
{
	float Kp=200.0,Ki=10.0,Kd=50.0;
	float error,d1;
	static unsigned char x=0;
	int output_pwm;//反馈输出PWM
	error=input_wendu-target;//实际温度-目标温度=误差
	if(x==0)
	{d1=error,x=~x;}
	error_all=error_all+error;//历史误差求和
	output_pwm=199.0+Kp*error+Ki*error_all+Kd*(error-d1);
	if((error>0)&&(output_pwm>999))//因占空比范围0/1000~1000/1000
	{
		show_zkb=999;
		return 999;
	}
	else if((error<0)&&(output_pwm<0))
	{
		show_zkb=0;
		return 0;
	}
	else
	{
		show_zkb=output_pwm;
		return output_pwm;	
	}
}
经验分享 程序员 微信小程序 职场和发展