电机控制进阶3——PID串级控制（附全套代码下载）

最新推荐文章于 2024-02-20 10:09:55 发布
最新推荐文章于 2024-02-20 10:09:55 发布
阅读量1.3w 收藏 650
点赞数 81
分类专栏： 电机控制与PID实践 文章标签： PID 串级控制 电机控制 单片机 STM32
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/hbsyaaa/article/details/117913573
版权

前两篇文章，分别介绍了PID速度控制和PID位置控制，分别用来控制电机以期望的速度持续转动以及以期望的位置（圈数）转动，这里的期望值都只有一个，但是，如果想要以期望的速度转动到期望的位置（启动与停止的加减速过程不考虑），该怎么控制呢？那就要将两者结合起来了，即PID的串级控制来控制电机。

串级PID结构图

PID串级控制的典型结构为位置环+速度环+电流环，如下图。

PID串级控制中，最外环是输入是整个控制系统的期望值，外环PID的输出值是内环PID的期望值。

能够使用三环控制的前提是要硬件支持，比如位置环和速度环需要实时的电机转动位置和转动速度作为反馈，这就需要电机需要配有编码器用于测速与测量转动的位置；电流环需要有电流采样电路来实时获取电机的电流作为反馈。

如果没有电流采样电路，可以将电流环去掉，只使用位置环+速度环，系统的期望仍是转动的位置，内环可以调节转动的速度。

另外，如果只是想控制电机转速实现电机调速，可以使用速度环+电流环，系统的期望仍是转动的位置，内环可以调节电机的电流，增强系统转动调节的抗干扰能力。

位置环+速度环实践

由于我的电机没有电流测量电路，所以，本文以位置环+速度环来学习PID串级控制。就是按照下面这个图：

PID参数定义

由于是串级PID控制，每一级的PID都要有自己的参数，本次实验使用位置PID+速度PID，参数定义如下：

/*定义位置PID与速度PID结构体型的全局变量*/
PID pid_location;
PID pid_speed;

/**
  * @brief  PID参数初始化
  *	@note 	无
  * @retval 无
  */
void PID_param_init()
{
	/* 位置相关初始化参数 */
	pid_location.target_val = TOTAL_RESOLUTION*10;				
	pid_location.output_val = 0.0;
	pid_location.err = 0.0;
	pid_location.err_last = 0.0;
	pid_location.integral = 0.0;

	pid_location.Kp = 0.05;
	pid_location.Ki = 0;
	pid_location.Kd = 0;

	/* 速度相关初始化参数 */
	pid_speed.target_val=10.0;				
	pid_speed.output_val=0.0;
	pid_speed.err=0.0;
	pid_speed.err_last=0.0;
	pid_speed.integral=0.0;

	pid_speed.Kp = 80.0;
	pid_speed.Ki = 2.0;
	pid_speed.Kd = 100.0;
}

位置PID的实现

这里有两点需要注意：

闭环死区的设定

闭环死区是指执行机构的最小控制量，无法再通过调节来满足控制精度，如果仍然持续调节，系统则会在目标值前后频繁动作，不能稳定下来。

比如某个系统的控制精度是1，但目标值需要是1.5，则无论怎么调节，最终的结果只能控制在 1或 2，始终无法达到预设值。这 1.5L小数点后的范围，就是闭环死区，系统是无法控制的，误差会一直存在，容易发生震荡现象。

对应精度要求不高的系统，可以设定闭环死区，比如将允许的误差范围设为0.5，则最终结果在 1或 2都认为是没有误差，这时将目标值 与实际值之差强制设为 0，认为没有误差，即限定了闭环死区。

积分分离的设定

通过积分分离的方式来实现抗积分饱和，积分饱和是指执行机构达到极限输出能力了，仍无法到达目标值，在很长一段时间内无法消除静差造成的。

例如，PWM输出到了100%，仍达不到期望位置，此时若一直进行误差累加，在一段时间后， PID 的积分项累计了很大的数值，如果这时候到达了目标值或者重新设定了目标值，由于积分由于累计的误差很大，系统并不能立即调整到目标值，可能造成超调或失调的现象。

解决积分饱和的一种方法是使用积分分离，该方法是在累计误差小于某个阈值才使用积分项，累计误差过大则不再继续累计误差，相当于只使用了PD控制器。

控制流程图

带有闭环死区与积分分离的PID控制流程如下图：

完整的位置PID代码如下：

/**
  * @brief  位置PID算法实现
  * @param  actual_val:实际值
  *	@note 	无
  * @retval 通过PID计算后的输出
  */
#define LOC_DEAD_ZONE 60 /*位置环死区*/
#define LOC_INTEGRAL_START_ERR 200 /*积分分离时对应的误差范围*/
#define LOC_INTEGRAL_MAX_VAL 800   /*积分范围限定，防止积分饱和*/
float location_pid_realize(PID *pid, float actual_val)
{
	/*计算目标值与实际值的误差*/
	pid->err = pid->target_val - actual_val;

	/* 设定闭环死区 */
	if((pid->err >= -LOC_DEAD_ZONE) && (pid->err <= LOC_DEAD_ZONE))
	{
		pid->err = 0;
		pid->integral = 0;
		pid->err_last = 0;
	}

	/*积分项，积分分离，偏差较大时去掉积分作用*/
	if(pid->err > -LOC_INTEGRAL_START_ERR && pid->err < LOC_INTEGRAL_START_ERR)
	{
		pid->integral += pid->err;  
        /*积分范围限定，防止积分饱和*/
		if(pid->integral > LOC_INTEGRAL_MAX_VAL)
		{
			pid->integral = LOC_INTEGRAL_MAX_VAL;
		}
		else if(pid->integral < -LOC_INTEGRAL_MAX_VAL)
		{
			pid->integral = -LOC_INTEGRAL_MAX_VAL;
		}
	}	

	/*PID算法实现*/
	pid->output_val = pid->Kp * pid->err +
	                  pid->Ki * pid->integral +
	                  pid->Kd * (pid->err - pid->err_last);

	/*误差传递*/
	pid->err_last = pid->err;

	/*返回当前实际值*/
	return pid->output_val;
}

速度PID实现

速度PID的实现代码与位置PID的类似：

/**
  * @brief  速度PID算法实现
  * @param  actual_val:实际值
  *	@note 	无
  * @retval 通过PID计算后的输出
  */
#define SPE_DEAD_ZONE 5.0f /*速度环死区*/
#define SPE_INTEGRAL_START_ERR 100 /*积分分离时对应的误差范围*/
#define SPE_INTEGRAL_MAX_VAL 260   /*积分范围限定，防止积分饱和*/
float speed_pid_realize(PID *pid, float actual_val)
{
	/*计算目标值与实际值的误差*/
	pid->err = pid->target_val - actual_val;

	/* 设定闭环死区 */
	if( (pid->err>-SPE_DEAD_ZONE) && (pid->err<SPE_DEAD_ZONE ) )
	{
		pid->err = 0;
		pid->integral = 0;
		pid->err_last = 0;
	}
    
	/*积分项，积分分离，偏差较大时去掉积分作用*/
	if(pid->err > -SPE_INTEGRAL_START_ERR && pid->err < SPE_INTEGRAL_START_ERR)
	{
		pid->integral += pid->err;  
        /*积分范围限定，防止积分饱和*/
		if(pid->integral > SPE_INTEGRAL_MAX_VAL)
		{
			pid->integral = SPE_INTEGRAL_MAX_VAL;
		}
		else if(pid->integral < -SPE_INTEGRAL_MAX_VAL)
		{
			pid->integral = -SPE_INTEGRAL_MAX_VAL;
		}
	}	
	
	/*PID算法实现*/
	pid->output_val = pid->Kp * pid->err +
	                  pid->Ki * pid->integral +
	                  pid->Kd *(pid->err - pid->err_last);

	/*误差传递*/
	pid->err_last = pid->err;

	/*返回当前实际值*/
	return pid->output_val;
}

串级控制代码

//周期定时器的回调函数
void AutoReloadCallback()
{
	static uint32_t location_timer = 0;    // 位置环周期
	
	static __IO int encoderNow = 0;    /*当前时刻总计数值*/
    static __IO int encoderLast = 0;   /*上一时刻总计数值*/
	int encoderDelta = 0; /*当前时刻与上一时刻编码器的变化量*/
	float actual_speed = 0;  /*实际测得速度*/
	int actual_speed_int = 0;
	
	int res_pwm = 0;/*PID计算得到的PWM值*/
	static int i=0;
	
	/*【1】读取编码器的值*/
	encoderNow = read_encoder() + EncoderOverflowCnt*ENCODER_TIM_PERIOD;/*获取当前的累计值*/
	encoderDelta = encoderNow - encoderLast; /*得到变化值*/
	encoderLast = encoderNow;/*更新上次的累计值*/
	
	/*【2】位置PID运算，得到PWM控制值*/
	if ((location_timer++ % 2) == 0)
	{
		float control_val = 0;   /*当前控制值*/
		
		/*位置PID计算*/
		control_val = location_pid_realize(&pid_location, encoderNow);  
		
        /*目标速度值限制*/
		speed_val_protect(&control_val);

		/*设定速度PID的目标值*/
		set_pid_target(&pid_speed, control_val);    
	}
	  
	/* 转速(1秒钟转多少圈)=单位时间内的计数值/总分辨率*时间系数, 再乘60变为1分钟转多少圈 */
    actual_speed = (float)encoderDelta / TOTAL_RESOLUTION * 10 * 60;
    
	/*【3】速度PID运算，得到PWM控制值*/
	actual_speed_int = actual_speed;
	res_pwm = pwm_val_protect((int)speed_pid_realize(&pid_speed, actual_speed));
	
	/*【4】PWM控制电机*/
	set_motor_rotate(res_pwm);
	
	/*【5】数据上传到上位机显示*/
	set_computer_value(SEND_FACT_CMD, CURVES_CH1, &encoderNow, 1);   /*给通道1发送实际的电机【位置】值*/
}

PID的计算是通过定时器调用，每10ms一次，从代码中可以看到，内环（速度PID）控制的周期要比外环（位置PID）的周期短，位置PID是每两次循环计算一次，因为内环控制着最终的输出，这个输出对应的就是实际场景中的控制量 (本实验最终控制的是位置)，位置是无法突变，是需要时间积累的，所以内环输出尽可能快些。

视频演示

视频中，测试以不同的目标速度到达目标位置，视频后半段测试引入干扰情况下的控制效果：

开源代码

本篇以及前面几篇电机与PID的完整程序代码，公众号回复“电机PID”获取，或点击阅读原文跳转至我的gitee仓库。

文章对你有帮助，欢迎转发、点赞、再看支持哦~

外环（位置PID）的周期短，位置PID是每两次循环计算一次，因为内环控制着最终的输出，这个输出对应的就是实际场景中的控制量 (本实验最终控制的是位置)，位置是无法突变，是需要时间积累的，所以内环输出尽可能快些。

视频演示

视频中，测试以不同的目标速度到达目标位置，视频后半段测试引入干扰情况下的控制效果：
视频：https://www.bilibili.com/video/BV1QK4y1g7yg
在这里插入图片描述

开源代码

本篇以及前面几篇电机与PID的完整程序代码已开源：
https://gitee.com/xxpcb/stm32-motor-pid
在这里插入图片描述

文章对你有帮助，欢迎转发、点赞支持哦~

码农爱学习
关注
  • 81
    点赞
  • 踩
  • 650
    收藏
    觉得还不错? 一键收藏
  • 15
    评论
专栏目录
matlab串级PID仿真_matlabsimulink_PID控制_
10-02
matlab中基于串级PID的simulink仿真，可直接调参使用，且增加了扰动模块。
520减速电机pid控制
07-16
速度一级闭环控制
【手把手带你用pid算法控制电机】——（4）串级PID控制电机
weixin_62261692的博客
04-20 7486
串级pid控制电机。
机器人关节伺服电机PID串级控制
FL1717的博客
06-14 3222
机器人关节电机三环控制
SIMATIC S7-1200 PID串级控制（以巧克力加热炉温度控制为例）
最新发布
laohei026的博客
02-20 3472
打开PID_Temp_2的调试面板，点击测量面板的start按钮，调节模式选择预调节加热，勾选控制器的在线状态面板里的Subst.Setpoint，设定一个满足预调节加热要求的数值，这里设置为80.0，然后点击旁边的闪电按钮，发送给PLC，最后点击调节面板的Start按钮，开始预调节加热。因为要进行串级调试，故在进行主控制器自整定之前，需要进行从控制器自整定，但从控制器的设定值是主控制器的输出值，无法手动修改，此时，可以用调试面板中的设定替代值作为从控制器的设定值。支持阀门的位置反馈和停止信号的检测；
串级PID
zhen
06-10 5477
pid
西门子300PID实例
10-14
是很多PID的实例，比较详细的描述了西门子300中PID的使用方法，及参数设定
单级和串级pid原理分析以及pid应用与小车的技巧
m0_62885376的博客
12-29 6362
你只需要知道你输出什么量他就会控制什么量就欧克了。输入位置（循迹模块）他就会控制位置，输入速度（编码器值）就会控制速度。对于循迹小车来说，一般只使用pd控制器。无论是那种循迹模块在测试时都会出现小车频繁左右摇摆的情况（即使加入了积分控制也不行），此时就需要用到pid死区。
【UAV】串级 PID 控制原理及应用
赵继超的笔记
11-16 9024
文章目录Ref： 给出串级 PID 伪代码： 当前角度误差=期望角度−当前角度外环PIDp项=外环Kp∗当前角度误差\begin{aligned} 当前角度误差 =& 期望角度 - 当前角度 \\ 外环 PID_p 项 =& 外环 Kp * 当前角度误差 \\ \end{aligned}当前角度误差=外环PIDp​项=​期望角度−当前角度外环Kp∗当前角度误差​ 当前角度误差积分及其积分限幅 外环PIDI项=外环Ki∗当前角度误差积分外环PID输出=外环PIDP项+外环PIDI项当前角速度
串级控制PID 炉温控制
qingfengxd1的博客
04-30 3651
控制原理： 由于炉温系统中的被控对象为电阻式加热炉，其输入只有电压，因此只能根据烤炉温度来调整电压的输入，用占空比的形式按周期输入电压能完成控制。具体就是系统根据烤炉温度计算出该加热时间然后转化为占空比，如计算出加热时间为5秒，控制周期选择为10秒，则在5秒内给烤炉供电而剩余5秒断电，即占空比为50%输入从而完成对烤炉电压输入。而核心部分为能根据烤炉的当前温度和设定值计算该加热的时间，相当于加入的校正环节，此环节采用PID控制。即当控制系统的性能指标不能满足生产要求或希望在不同的生产过程中各项性能指标能够调
飞控串级PID详解
10-09
飞控串级PID详解
matlab实现串级PID控制倒立摆
04-21
.m文件调用simulink实现倒立摆稳摆。每步仿真0.005s，每次仿真一步，每个循环调用一次simulink。 PID参数粗略调试，收敛效果一般，仅供参考。 主程序为PID_IP.m运行完毕后画出控制过程曲线
【速度环+位置环串级PID(大疆M3508减速电机套装】
09-17
STM32F1RCT6(【速度环+位置环串级PID(大疆M3508减速电机套装】)
串级PID算法设计总结
05-04
串级PID算法设计总结，应用平衡小车控制案例
基于STM32步进电机位置速度双环串级控制.rar
07-12
基于STM32的步进电机控制算法程序，包含位置环和速度环串级双环控制，内有源码，方便大家学习。
基于PLC的双容水箱液位串级PID控制的实现
01-28
文章以双容水箱为被控对象，S7-200PLC为控制器，设计了双容水箱的液位串级控制实验。液位信号经液位变送器送至PLC，采用PID算法对数据进行处理，之后输出至电动调节阀来实现对液位的控制。采用一步整定法确定了主、...
pid串级控制.zip_PI 串级_pid 串级控制_串级 PI_串级PID_控制
07-14
通过P PI PID 分析一次扰动和二次扰动对系统的影响。
PID串级控制simulink仿真_pid_simulink串级_SIMULINK_PIDcascadecontrol_
10-01
PID串级控制结构和simulink仿真
dmc-pid串级控制matlab代码
05-30
以下是一个基于DMC-PID串级控制的Matlab代码示例： ```matlab % 系统模型 s = tf('s'); G1 = 1/(s*(s+1)); G2 = 1/(0.5*s+1); % 控制器参数 N = 50; % 预测步数 Nu = 20; % 控制步数 lambda = 1; % 控制器惩罚因子 M = 2; % 串级控制器个数 % DMC-PID串级控制器 for i = 1:M if i == 1 Gc = dmc_pid(G1,N,Nu,lambda); else Gc = dmc_pid(G2,N,Nu,lambda); end if i == 1 G = G1; else G = G2; end Gcl{i} = feedback(G*Gc,1); end % 绘图比较 t = 0:0.01:10; u = sin(t); [y1,t] = lsim(Gcl{1},u,t); [y2,t] = lsim(Gcl{2},y1,t); plot(t,u,'b',t,y1,'r',t,y2,'g'); legend('输入信号','一级控制输出','二级控制输出'); % DMC-PID控制器函数 function Gc = dmc_pid(G,N,Nu,lambda) % 系统阶数 [n,m] = size(G); % 计算K、Ku和Ke D = zeros(N,Nu); for i = 1:N for j = 1:Nu if (i >= j) D(i,j) = G(i-j+1); end end end K = inv(D'*D+lambda*eye(Nu))*D'; Ku = K(1,:)*D; Ke = sum(K(1,:)); % 控制器参数计算 deltau = zeros(Nu,1); y = zeros(n,1); yp = zeros(n,N); ym = zeros(n,Nu); du = zeros(Nu,1); % 控制器函数 function u = controller(yd,y) % 计算deltau e = yd-y; deltau(2:Nu) = deltau(1:Nu-1); deltau(1) = Ku*e-Ke*du; % 计算u du = deltau(1)+K(2:end,:)*deltau; u = du(1); end % 控制器输出函数 function [y,t] = output(u,t) for k = 1:length(t) y(k) = G*[u(k);y(k-1:-1:max(k-N+1,1))]; ym(:,2:Nu) = ym(:,1:Nu-1); ym(:,1) = y-yd(k); deltau = K*ym(:); du = deltau(1)+K(2:end,:)*deltau; u(k) = u(k-1)+du(1); end end % 输出控制器函数 Gc = @controller; Gc.output = @output; end ``` 需要注意的是，DMC-PID串级控制器需要对每个控制器单独进行参数计算，然后将其级联起来形成串级控制器。在控制器函数中，需要计算deltau和u两个变量，并在每个采样周期内更新控制器输出。在控制器输出函数中，需要计算系统输出和误差，并根据误差计算deltau和du，最终得到控制器输出u。

“相关推荐”对你有帮助么？

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 15
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值