stm32单片机实现电机的PID控制

简介: stm32单片机实现电机的PID控制

    PID控制应该算是非常古老而且应用非常广泛的控制算法了,小到热水壶温度控制,大到控制无人机的飞行姿态和飞行速度等等。在电机控制中,PID算法用得尤为常见。

一、位置式PID

1.计算公式

在电机控制中,我们给电机输出的是一个PWM占空比的数值。

话不多说,直接上位置式PID基本公式:

控制流程图如下:

上图中的目标位置一般我们可以通过按键或者开关等方式编程实现改变目标值,测量位置就是通过 stm32 去采集编码器的数据。

目标位置和测量位置之间作差就是目前系统的偏差。送入 PID 控制器进行计算输出,然后再经过电机驱动的功率放大控制电机的转动去减小偏差, 最终达到目标位置的过程。

2.C语言实现

如何把我们以上的理论分析和控制原理图使用 C 语言写出来呢,这是一个有趣且实用的过程。位置式 PID 具体通过 C 语言实现的代码如下:

int Position_PID (int Encoder,int Target){  static float Bias,Pwm,Integral_bias,Last_Bias;  Bias=Target- Encoder; //计算偏差  Integral_bias+=Bias; //求出偏差的积分  //PID基本公式  Pwm=Position_KP*Bias+Position_KI*Integral_bias+Position_KD*(Bias-Last_Bias);  Last_Bias=Bias; //保存上一次偏差  return Pwm; //输出}

入口参数为编码器的位置测量值和位置控制的目标值,返回值为电机控制PWM(现在再看一下上面的控制框图是不是更加容易明白了)。

第一行是相关内部变量的定义。

第二行是求出位置偏差,由测量值减去目标值。

第三行通过累加求出偏差的积分。

第四行使用位置式 PID 控制器求出电机 PWM。

第五行保存上一次偏差,便于下次调用。

最后一行是返回。

二、增量式PID

1.计算公式

速度闭环控制就是根据单位时间获取的脉冲数(这里使用了 M 法测速)测量电机的速度信息,并与目标值进行比较,得到控制偏差,然后通过对偏差的比例、积分、微分进行控制,使偏差趋向于零的过程。

在我们的速度控制闭环系统里面只使用 PI 控制,因此对 PID 控制器可简化

为以下公式:

控制框图和位置式的一样的。

上图中的目标速度一般我们可以通过按键或者开关等方式编程实现改变目标值,测量速度前面在编码器的章节已经有说到就是通过单片机定时去采集编码器的数据并清零。

目标速度和测量速度之间做差就是目前系统的偏差。送入 PID 控制器进行计算输出,然后再经过电机驱动的功率放大控制电机的转动去减小偏差, 最终达到目标速度的过程。

2.C语言实现

如何把我们以上的理论分析和控制原理图使用 C 语言写出来呢,这是一个有趣且实用的过程。位置式 PID 具体通过 C 语言实现的代码如下:

int Incremental_PI (int Encoder,int Target){  static float Bias,Pwm,Last_bias;  Bias=Encoder-Target; //计算偏差  //增量式 PI 控制器  Pwm+=Velocity_KP*(Bias-Last_bias)+Velocity_KI*Bias;  Last_bias=Bias; //保存上一次偏差  return Pwm; //增量输出}

入口参数为编码器的速度测量值和速度控制的目标值,返回值为电机控制 PWM。

第一行是相关内部变量的定义。

第二行是求出速度偏差,由测量值减去目标值。

第三行使用增量 PI 控制器求出电机 PWM。

第四行保存上一次偏差,便于下次调用。

最后一行是返回。

三、P、I、D各个参数的作用

自动控制系统的性能指标主要有三个方面:稳定性、快速性、准确性。

稳定性:系统在受到外作用后,若控制系统使其被控变量随时间的增长而最终与给定期望值一致,则称系统是稳定的,我们一般称为系统收敛。

如果被控量随时间的增长,越来越偏离给定值,则称系统是不稳定的,我们一般称为系统发散。稳定的系统才能完成自动控制的任务,所以,系统稳定是保证控制系统正常工作的必要条件。

一个稳定的控制系统其被控量偏离给定值的初始偏差应随时间的增长逐渐减小并趋于零。

快速性:快速性是指系统的动态过程进行的时间长短。过程时间越短,说明系统快速性越好,过程时间持续越长,说明系统响应迟钝,难以实现快速变化的指令信号。

稳定性和快速性反映了系统在控制过程中的性能。系统在跟踪过程中,被控量偏离给定值越小,偏离的时间越短,说明系统的动态精度偏高。

准确性:是指系统在动态过程结束后,其被控变量(或反馈量)对给定值的偏差而言,这一偏差即为稳态误差,它是衡量系统稳态精度的指标,反映了动态过程后期的性能。

在实践生产工程中,不同的控制系统对控制器效果的要求不一样。比如平衡车、倒立摆对系统的快速性要求很高,响应太慢会导致系统失控。

智能家居里面的门窗自动开合系统,对快速性要求就不高,但是对稳定性和准确性的要求就很高,所以需要严格控制系统的超调量和静差。

目录
相关文章
|
7月前
|
传感器 编解码 数据处理
毕业设计|基于STM32单片机的水位浑浊度检测设计
毕业设计|基于STM32单片机的水位浑浊度检测设计
891 0
|
7月前
|
传感器 芯片
毕业设计 基于51单片机霍尔电机转速测量温度PWM调速设计
毕业设计 基于51单片机霍尔电机转速测量温度PWM调速设计
112 0
|
7月前
|
芯片
毕业设计|基于stm32单片机的app视频遥控抽水灭火小车设计
毕业设计|基于stm32单片机的app视频遥控抽水灭火小车设计
104 0
|
2月前
|
传感器 监控 JavaScript
千套单片机\stm32毕设课设题目及资料案列-干货分享
为帮助电子工程领域的学习者顺利毕业或掌握更多专业知识,我们精心整理了一系列单片机和STM32相关的题目及资料案例。这些资源覆盖了从毕业设计到课程设计的各个方面,包括但不限于智能小车、温度控制系统、无线通信、智能家居等多个领域。每项设计都配有详细的原理图、仿真图以及完整的文档资料,旨在帮助学生深入理解理论知识的同时,提高实际动手操作能力。无论是初学者还是有一定基础的学生,都能从中找到适合自己的项目进行实践探索。
373 8
|
5月前
|
算法
STM32CubeMX PID差速循迹小车
STM32CubeMX PID差速循迹小车
127 1
STM32CubeMX PID差速循迹小车
|
5月前
单片机课程设计——PWM电机调速
单片机课程设计——PWM电机调速
|
6月前
|
Web App开发 传感器 Linux
【嵌入式软件工程师面经】STM32单片机
【嵌入式软件工程师面经】STM32单片机
170 1
|
7月前
【STM32】使用单片机DAC产生噪声群
【STM32】使用单片机DAC产生噪声群