智能车电机系统辨识和PID仿真自动调参

使用 Matlab 的 System Identification 系统辨识工具箱,辨识出传递函数;用 Simulink 仿真控制系统;PID Tuner 自动整定 PID 参数

步骤:系统辨识传递函数 -> Simulink仿真 -> PID Tuner自动调参

系统辨识传递函数

采集数据

这里选择根据输入和输出数据辨识传递函数。

具体到智能车电机的话,就是在电机开环的情况下,给定电机恒定的占空比,将车放到赛道上,记录电机速度(编码器返回值)从0到接近稳定的曲线。

  • 一定要开环测量数值,就是单纯给PWM即可。

  • 给电机占空比的具体数值,最好使用电机以日常速度跑的时候的占空比。电机在正常运行的区间内,理论上这个关系应该是线性的,用任何占空比最终的效果都会差不多,但考虑到实际情况还是在日常使用的占空比范围区间内选取定值比较好,不过也不用过于纠结这里。
  • 将车放到赛道上跑,是为了模拟实际在赛道上竞速时电机的负载情况。没有足够大小的赛道或是场地的话,找个摩擦相似的地面也可以。

  • 采集数据,一定要以固定的频率发送给上位机。

    可以用串口转蓝牙的无线串口,配合匿名上位机完成原始数据的采集。

Simulink1

导入数据

导入数据到 Matlab

我使用的环境是 Matlab R2020b。

(Matlab 从 R2019a 开始就有了 STM32 的硬件支持包,Simulink 可以直接生成能下载到板子中运行的代码和程序。不过这部分我还没探索完咕咕咕

首先,在顶部选择导入数据,打开匿名上位机保存出来的CSV文件,选中速度的那列数据,并在上方将输出类型更改为数值矩阵,最后点击右侧将电机转速数据导入工作区。

还需要输入数据,也就是给电机的PWM定值。因为是定值所以只需要创建一个与输出数据元素个数相同的列向量即可。以上面图片的数据和情况为例,则是 PWM = linspace(1000,1000,170) `。 注意需要在最后加上 “ ‘ ” 将行向量转为列向量。

导入数据到系统辨识工具箱

系统辨识这边我们自然选择的是根据数据建模的方案,而非直接使用机理建模。

之后在 Matlab 的 App 中选择 System Identification

在左侧import data导入数据,导入的数据可以包括时域的也可以包括频域的,这里我们以选择Time domain data导入时间域数据为例。

Workspace Variable里的input为输入数据,填写matlab工作区内的输入数据变量名即PWM;Output即需要填入输出转速变量名

Data Information里的Starting time为起始时间设为0即可;Sample time为采样时间单位是s,根据自己单片机程序里设置的编码器的采样时间输入。注意编码器的采样频率应该和串口接收数据(也就是matlab工作区里的电机转速数据)的频率相同,不过如果丢包率很低也可以不用太在意。

勾选time plot会显示数据,可以检查数据是否正确。

Simulink2

系统辨识

接下来将左侧的mydata曲线拖动到Working Data中。要对数据进行操作时,都要把数据拖到Working Data中才能生效。

正常需要对电机转速的数据进行预处理。但因为我在单片机串口发送的数据就已经是一阶低通后的数据,所以可以不用再处理这部分。

Estimate选择Transfer Function Models,然后设置合适的零点极点。电机模型一般零点为1极点为2。

由于我们的转速的编码器采集的离散数据,所以我们需要将默认的连续性数据选项改为Discrete-time (Ts = 0.0x)(由于后面仿真的时候节点选的都是连续型,这里也就先按连续型做系统辨识,为了尽量保证准确性等我开学回实验室再次验证下之后再更新成离散型

I/O Delay是延时时间不用管默认0即可。也可以取消勾选Time delay中的Fixed,设置好Minimum和Maximum后会在区间内自动辨识时间延迟。

Estimate等待一小段时间的计算后即会计算出结果。拟合率一般80%为经验可用的界限。此时右侧的模型窗口出现了辨识的tf1

勾选Model output即可查看辨识结果。将辨识结果与原始实验数据叠加在一起,可以看到模型的辨识效果很好。

Simulink8

(只是为了演示就只采集了一小部分数据采样频率也不高

把辨识结果tf1拖拽到To Workspace即可导出到工作区,系统辨识完成。这时回到Matlab主窗口即可查看工作区里tf1的信息。

Simulink3

Simulink 仿真

按图连接节点,名称已经标出

Simulink4

也可以加入延迟模块模拟电机系统

(离散型其实应该使用的是Discrete PID Controller和Discrete Transfer Fcn

双击Transfer Fcn填入刚刚辨识完的传递函数。具体数据双击工作区的tf1直接复制tf1.Denominatortf1.Numerator即可

PID Tuner 自动调参

双击PID Tuner

Simulink5

上方Controller可以选择使用PID还是PI/PD/P/I

右下方Automated tuning中,选择Transfer Function Based (PID Tuner App) ,之后点击Tune即可开始调参。

Simulink6

DESIGN中的Domain可以选择使用时间还是频率

在左上方CONTROLLEROptions可以更改设计偏好(Design Focus)。默认为Balanced,可选Reference tracking/Input disturbance rejection

调节上方两个按钮,Response Time (seconds)是上升时间(单位秒),另一个Transient Behavior可以理解成超调量。

实线为当前参数仿真效果,虚线为调整前的参数,方便对比。

Show Parameters为当前参数,以及各项指标。注意PID Tuner计算连续型时的积分项I需要乘上系统的采样时间(单位秒)才是常规位置式PID的参数。PID Tuner调参完成。

另外PID Tuner整定参数的结果验证和Simulate后Scope显示的是一致的。

Simulink7

其他

其实PID Tuner出来的参数直接就已经是可以用的程度了。另外仿真也可以给出一个大概的参数范围,在这个结果上依据实际情况再修改参数,也会有更好的效果。我们最终在国赛时四个电机的速度环,就是在仿真出的参数的基础上调了一个小时左右就最终确定了的。

参考资料:

PID Controller https://ww2.mathworks.cn/help/simulink/slref/pidcontroller.html

System Identification 官方帮助文档 https://ww2.mathworks.cn/help/ident/index.html

System Identification Toolbox https://ww2.mathworks.cn/products/sysid.html

STM32硬件支持包 https://ww2.mathworks.cn/products/hardware/stmicroelectronics.html