STM32CubeMX(15) —— 串级PID以控制电机角度值为例

lzzzzzzm

已于 2023-05-20 12:55:07 修改

阅读量8.2k

点赞数 24

分类专栏： STM32 文章标签： stm32 python 控制 PID 单片机

于 2021-10-14 07:00:00 首次发布

本文链接：https://blog.csdn.net/lzzzzzzm/article/details/120751020

版权

STM32 专栏收录该内容

15 篇文章 173 订阅

订阅专栏

本文详细介绍了如何使用串级PID控制电机的角度。首先，分析了单级PID控制电机角度的问题，指出由于PWM到角度的转换函数不易控制。接着，引入串级PID，通过增加速度环来改善控制效果，确保输出速度符合预期。文章提供了串级PID的代码实现，包括电机结构体、PID计算和初始化，并分享了调参方法，强调先稳定内环再调外环。最后，提到了实际应用中的调参经验，并提供了代码链接。

摘要由CSDN通过智能技术生成

串级PID以控制电机角度值为例

前言

很早前说要补的坑，今天补一下。之前介绍过单级的PID来控制电机的速度值,建议先看下面这篇文章，因为后面代码和这篇文章有关联！

STM32 Cubemax(七) —— 单级PID控制带编码器的直流减速电机速度

而这次，我们来讲解一下怎么控制电机的角度，如果用单级PID控制角度会有什么问题，为什么要用串级PID。

当然串级PID不只是可以控制电机的角度，如现在诸多的控制系统，倒立摆，风力摆，平衡小车等等，都是基于串级PID的控制。

一、单级PID控制电机角度

如果还用我们之前熟知的单级PID来控制角度值，我们很容易的可以得出以下框图。

看上去很完美，没有什么问题，但这里面最大的问题就在于单片机给电机的是PWM值（或者电压值）并不是直接给定电机旋转的角度值，而可以认为是经过一个函数变换f（PWM）得出的值。

比如这里以角度为例，PWM输出的值，经过一个g（x）变换得到速度值，速度值经过h（x）（即积分）得到角度值，f（PWM）即为h（g（x））。

根据上述分析可知，对于简单的系统来说，这个f函数的变换，可以用较好的PID参数来抵消掉其中的误差量。但当系统变的复杂，比如平衡小车中，控制的角度不仅是单纯电机的角度，而是车上的位姿姿态，这种时候f（x）就较为复杂！这种时候，十分难得到一个PID参数来使系统稳定。

所以当我们遇到控制问题时，先看看这个f函数，是不是属于我上述说的情况，来看看单级PID是否可以使用。

我们接下来引入串级PID来解决上述f函数出现的问题。

二、串级PID

其实单级PID来控制角度，出现的具体问题就是控制反馈不全导致的！

以控制角度为例，其中最大的问题不在于h（x），因为h（x）相当于速度对时间的积分，问题在于g（x）的存在，输出的PWM会经过g（x）得出一个不可控的速度值（因为存在电机阻尼，或者外届阻力等），那么此时经过h（x）得出的角度值，也不会如我们想控制的一样。

那么解决方案就很简单了，就是去控制这个速度值，使其输出的速度值是我们控制器想要得到的值即可了。我们容易得出下面框图。

这里我们加了一级速度级PID来控制电机的输出速度，外面外环仍然使用一级角度级PID来控制电机最终速度角度，这就是串级的意义。

其本质内涵，可以认为速度环的引入，相当于给系统增加了阻尼，即抑制了g（x）中因为电机阻尼，外界阻尼等因素的影响。

三、串级PID代码

其实如果看懂上面串级PID的框图后，代码编写也十分简单了，就是相当于计算两次单级PID，其中外环角度环的目标值为设定的角度，反馈值为电机反馈的角度值，内环速度环的输入即为外环角度环的输出，反馈为电机反馈的速度值。

电机结构体

串级PID结构体

typedef struct _CascadePID
{
	PID inner;    // 内环速度环PID
	PID outer;    // 外环角度环PID
	float output;
}CascadePID;

在电机中加入串级PID

typedef struct _Motor
{
	int32_t lastAngle;       //上次计数结束时转过的角度
	int32_t totalAngle;      //总共转过的角度
	int16_t loopNum;         //电机计数过零计数
	float speed;             //电机输出轴速度
	float targetSpeed;       //添加设定的目标速度
    CascadePID anglePID;     //串级PID 
}Motor;

串级PID计算

//串级PID计算，参数为串级PID指针，角度目标值，角度返回值，速度返回值
void PID_CascadeCalc(CascadePID *pid,float angleRef,float angleFdb,float speedFdb)
{
	PID_SingleCalc(&pid->outer,angleRef,angleFdb);            //外环角度环
	PID_SingleCalc(&pid->inner,pid->outer.output,speedFdb);   //内环速度环
	pid->output=pid->inner.output;
}

串级PID初始化

即对内环和外环的参数进行初始化

PID_Init(&Motor.anglePID.inner,0,0.0,0,0,0);
PID_Init(&Motor.anglePID.outer,0,0,0,0,0,0);

然后外面只需要把Motor_Send里的单级PID计算更换成我们的串级PID计算，就完成了串级PID的计算，这里要解释一下就是这里我们角度的返回值，填的是totalAngle，即我们编码器总读出来的角度值，所以我们这里targetAngle是基于totalAngle上的累加值。

void Motor_Send(enum Mode mode)
{
	float output = 0;
	PID_CascadeCalc(&motor.anglePID, motor.targetAngle, motor.totalAngle, motor.speed);
	output = motor.anglePID.output;
	
	if(output > 0)
	{
		__HAL_TIM_SetCompare(&htim5, TIM_CHANNEL_2, (uint32_t)output);
		IN1(0);
		IN2(1);
	}
	else										
	{
		__HAL_TIM_SetCompare(&htim5, TIM_CHANNEL_2, (uint32_t)(-output));
		IN1(1);
		IN2(0);
	}
}