【STM32】单级与串级PID的C语言实现
前言
笔者最近在学习PID控制器,本文基于Blog做以总结。CSDN上已有大量PID理论知识的优秀文章,因此本文将略写理论部分,重点放在应用。
PID理论
什么是PID
PID(比例-积分-微分)控制器是一种广泛用于自动控制系统的闭环反馈控制器,能够实现系统的稳定、快速和精确控制。
PID计算过程
单级PID
串级PID
串级PID分为外环和内环,是两个单级PID嵌套构成的
PID计算公式
连续型
离散型
Pout、Iout、Dout的作用
- Pout:主要负责控制,使反馈量快速接近目标值,但可能引起振荡
- Iout:消除稳态误差,但会增加超调
- Dout:提供阻尼,抑制振荡和超调,但可能降低响应速度
单级PID与串级PID
我们来思考一下:为什么自动控制系统中要引入PID?能否直接控制目标值?先来看个常见的PID应用例子
例子一:水阀控制水量
在这个例子中,目标值是水槽的水量(也即水面高度,量纲为长度,单位为m)。而可直接控制的变量是水阀的开度(即水流速度,量纲为速度,单位为m/s)。
注意,控制量相较于目标值为低一阶物理量,故我们无法直接控制高阶物理量(水面高度),只能控制低阶物理量(水流速度)。
(此时因为控制量与目标值只差一阶,所以单级PID即可。假设我们不能直接控制水流速度,只能直接控制水流的加速度,那么就需要串级PID控制了)
因此引入PID控制器,为了更好的通过控制低阶物理量完成对高阶物理量的控制
ps:水面高度和水体积呈线性关系,水阀开度和水流速也是线性相关,因此通过合理调节PID参数,系统可以自适应这种内含的线性关系
例子二:循迹小车
在这个例子中,目标是控制小车位置,目标值是小车目标位置,而可直接控制的变量是电机电流(可以理解为加速度或力)。由于电流(加速度)与位置之间相差两阶,因此需要使用串级PID控制
具体做法:
- 外环PID:根据目标位置和当前实际位置的误差,输出一个目标速度给内环PID
- 内环PID:根据目标速度和当前实际速度的误差,输出控制量(如PWM占空比)来给执行器
这种串级PID控制方法,通过外环控制速度、调节位置,内环控制PWM、调节速度,从而实现了精准的循迹控制
PID应用
单级PID
pid.h
#ifndef __PID_H__
#define __PID_H__
/* USER CODE BEGIN Includes */
/* USER CODE END Includes */
//首先定义PID结构体用于存放一个PID的数据
typedef struct
{
float kp, ki, kd; //三个系数
float error, lastError; //误差、上次误差
float integral, maxIntegral; //积分、积分限幅
float output, maxOutput; //输出、输出限幅
}PID;
void PID_Init(PID *pid, float p, float i, float d, float maxI, float maxOut);
void PID_Calc(PID *pid, float reference, float feedback);
#endif
pid.c
#include "pid.h"
PID speed_pid_speed = {0}; //定义并初始化一个PID结构体变量,单级速度环
//初始化pid参数的函数
void PID_Init(PID *pid, float p, float i, float d, float maxI, float maxOut)
{
pid->kp = p;
pid->ki = i;
pid->kd = d;
pid->maxIntegral = maxI;
pid->maxOutput = maxOut;
}
//进行一次PID控制器的计算,更新控制量:pid->output
//参数为(pid结构体,目标值,反馈值),计算结果放在pid结构体的output成员中
void PID_Calc(PID *pid, float reference, float feedback)
{
//更新数据
pid->lastError = pid->error; //将旧error存起来
pid->error = reference - feedback; //计算新error
//计算比例
float pout = pid->error * pid->kp;
//计算积分
pid->integral += pid->error * pid->ki;
//计算微分
float dout = (pid->error - pid->lastError) * pid->kd;
//积分限幅
if(pid->integral > pid->maxIntegral) pid->integral = pid->maxIntegral;
else if(pid->integral < -pid->maxIntegral) pid->integral = -pid->maxIntegral;
//计算输出
pid->output = pout+dout + pid->integral;
//输出限幅
if(pid->output > pid->maxOutput) pid->output = pid->maxOutput;
else if(pid->output < -pid->maxOutput) pid->output = -pid->maxOutput;
}
my_main.c
void setup(void)
{
PID_Init(&speed_pid,1,0,0,0,1000); //举例
}
void loop(void)
{
//更新被控对象反馈值和目标值(反正要不断更新、获取
PID_Calc(&speed_pid,targetValue,feedbackValue);
设置执行器输出大小(speed.output);//在控制电机转速的单级速度环pid中,控制执行器的操作为set_pwm(speed.output);
HAL_Delay(10); //控制采样周期,防止频繁计算导致系统抖动与资源消耗过高(根据不同情况合理配置即可
}
串级PID
pid.h
#ifndef __PID_H__
#define __PID_H__
/* USER CODE BEGIN Includes */
/* USER CODE END Includes */
//首先定义单级PID结构体
typedef struct
{
float kp, ki, kd; //三个系数
float error, lastError; //误差、上次误差
float integral, maxIntegral; //积分、积分限幅
float output, maxOutput; //输出、输出限幅
}PID;
//再定义串级PID的结构体,嵌套两个单级PID
typedef struct
{
PID inner; //内环
PID outer; //外环
float output; //串级输出,等于inner.output
}CascadePID;
void PID_Init(PID *pid, float p, float i, float d, float maxI, float maxOut);
void PID_Calc(PID *pid, float reference, float feedback);
void PID_CascadeCalc(CascadePID *pid, float outerRef, float outerFdb, float innerFdb);
#endif
pid.c
//初始化pid参数的函数
void PID_Init(PID *pid, float p, float i, float d, float maxI, float maxOut)
{
pid->kp = p;
pid->ki = i;
pid->kd = d;
pid->maxIntegral = maxI;
pid->maxOutput = maxOut;
}
//进行一次PID控制器的计算,更新控制量:pid->output
//参数为(pid结构体,目标值,反馈值),计算结果放在pid结构体的output成员中
void PID_Calc(PID *pid, float reference, float feedback)
{
//更新数据
pid->lastError = pid->error; //将旧error存起来
pid->error = reference - feedback; //计算新error
//计算比例
float pout = pid->error * pid->kp;
//计算积分
pid->integral += pid->error * pid->ki;
//计算微分
float dout = (pid->error - pid->lastError) * pid->kd;
//积分限幅
if(pid->integral > pid->maxIntegral) pid->integral = pid->maxIntegral;
else if(pid->integral < -pid->maxIntegral) pid->integral = -pid->maxIntegral;
//计算输出
pid->output = pout+dout + pid->integral;
//输出限幅
if(pid->output > pid->maxOutput) pid->output = pid->maxOutput;
else if(pid->output < -pid->maxOutput) pid->output = -pid->maxOutput;
}
//串级PID的计算函数(调用两次单级PID计算,先算外环再算内环,串级cascade_pid->output被更新
//参数(串级PID结构体,外环目标值,外环反馈值,内环反馈值)
void PID_CascadeCalc(CascadePID *pid, float outerRef, float outerFdb, float innerFdb)
{
PID_Calc(&pid->outer, outerRef, outerFdb); //先计算外环
PID_Calc(&pid->inner, pid->outer.output, innerFdb); //再计算内环
pid->output = pid->inner.output; //控制量 = 内环输出 = 串级PID的输出(所以
}
my_main.c
内环 PID 控制频率应高于外环,以保证内环能快速响应动态变化。建议避免内外环在同一周期更新,最好通过定时中断分别计算单级和串级 PID 控制,确保系统稳定性和响应速度
void setup(void)
{
CascadePID cascade_pid = {0}; //创建串级PID结构体变量
PID_Init(&cascade_pid.inner, 10, 0, 0, 0, 1000); //初始化内环参数
PID_Init(&cascade_pid.outer, 5, 0, 5, 0, 100); //初始化外环参数
}
void loop(void)
{
//更新、获取外环目标值、外环反馈值、内环反馈值
PID_CascadeCalc(&cascade_pid, outerTarget, outerFeedback, innerFeedback); //进行串级PID计算
设定执行机构输出大小(cascade_pid.output); //在循迹控制中,控制执行输出为set_pwm(cascade_pid.output)
HAL_Delay(10); //控制采样周期,防止频繁计算导致系统抖动与资源消耗过高(根据不同情况合理配置即可
}