STMCU小助手
发布时间:2022-1-8 20:00
|
首先说说增量式PID的公式,这个关系到MCU算法公式的书写,实际上两个公式的写法是同一个公式变换来得,不同的是系数的差异。, K* I/ t2 i# H. g( @ 资料上比较多的是: t$ h+ q' V0 n3 P" c1 @3 ] ![]() 还有一种是:7 R4 [& D1 m# T; D2 n1 ~$ @ ![]() 感觉第二种的Kp Ki Kd比较清楚,更好理解,下面介绍的就以第二种来吧。(比例、积分、微分三个环节的作用这里就详细展开,百度会有很多)# M. t4 e0 Z. @9 d" V4 W5 {9 m 硬件部分:- y( i" }) V1 l: s# V 控制系统的控制对象是4个空心杯直流电机,电机带光电编码器,可以反馈转速大小的波形。电机驱动模块是普通的L298N模块。2 J; {: V6 F1 w 芯片型号,STM32F103ZET6& i4 d. w4 l* ~ 软件部分:2 {4 x( j- w, e" L& M' w PWM输出:TIM3,可以直接输出4路不通占空比的PWM波4 s! x, K% k2 h" r8 o: `' Q PWM捕获:STM32除了TIM6 TIM7其余的都有捕获功能,使用TIM1 TIM2 TIM4 TIM5四个定时器捕获四个反馈信号 PID的采样和处理:使用了基本定时器TIM6,溢出时间就是我的采样周期,理论上T越小效果会越好,这里我取20ms,依据控制对象吧,如果控制水温什么的采样周期会是几秒几分钟什么的。 上面的PWM输出和捕获关于定时器的设置都有例程,我这里是这样的:; Y. Y, @* A- z( o TIM3输出四路PWM,在引脚 C 的 GPIO_Pin_6 | GPIO_Pin_7 | GPIO_Pin_8 | GPIO_Pin_9输出+ m, h1 f4 _6 x" z 四路捕获分别是TIM4 TIM1 TIM2 TIM5 ,对应引脚是: PB7 PE11 PB3 PA1, N+ s. _7 J0 A5 G' _" P 高级定时器tim1的初始化略不同,它的中断”名称“和通用定时器不同,见代码:
[color=rgb(51, 102, 153) !important]复制代码
[color=rgb(51, 102, 153) !important]复制代码# P& H5 G) b3 Y9 v 游客,如果您要查看本帖隐藏内容请回复 " K9 L2 W+ G/ | 上面几个代码是PID实现的关键部分+ z' W7 i1 e4 x" }! n; h& W* K + {& |2 Y- J; r6 w 整定过程:9 B- n7 M9 W* _( f 办法有不少,这里用的是先KP,再TI,再TD,在微调。其他的办法特别是有个尼古拉斯法我发现不适合我这个控制对象。( _) k" z$ P# X( L, } 先Kp,就是消除积分和微分部分的影响,这里我纠结过到底是让Ti 等于一个很大的值让Ki=Kp*(T/Ti)里面的KI接近零,还是直接定义KI=0,TI=0. 然后发现前者没法找到KP使系统震荡的临界值,第二个办法可以得到预期的效果:即KP大了会产生震荡,小了会让系统稳定下来,当然这个时候是有稳态误差的。; `& l4 ^' l9 t7 r. Y; u; Y+ f 随后把积分部分加进去,KI=Kp*(T/Ti)这个公式用起来,并且不断调节TI 。TI太大系统稳定时间比较长。6 B( `$ f7 g5 x/ S4 m 然后加上Kd =Kp*(Td/T),对于系统响应比较滞后的情况效果好像好一些,我这里的电机反映挺快的,所以Td值很小。' U8 X0 @, o! z4 V! ?( o3 K 最后就是几个参数调节一下,让波形好看一点。这里的波形实际反映的是采集回来的转速值,用STM32的DAC功能输出和转速对应的电压,用示波器采集的。 最后的波形是这样的:" I" T- E6 J* P% ?9 J6 a % l' o- v1 \5 N$ N" P最后欢迎大家拍砖,有批评才会让我更加进步!& h p0 t0 ?% _; r2 n) Q |
实战经验 | 基于STM32G0B1的全桥移相+同步整流PWM解决方案
DMA 原理从 0 到 1:为什么它能解放 CPU?一文讲透 DMA 的工作流程
【福利三:逢7发帖赢大礼】8、基于STM32G070板子的Ymodem串口协议IAP Bootloader开发
【福利三:逢7发帖赢大礼】7、基于STM32G070板子TF卡的FATFS移植
【福利三:逢7发帖赢大礼】6、基于STM32G070板子spiflash的FATFS移植
【福利三:逢7发帖赢大礼】5、基于STM32G070板子IRDA红外遥控接收解码
【福利三:逢7发帖赢大礼】4、基于STM32G070板子SPI flash 移植SFUD库
【福利三:逢7发帖赢大礼】基于STM32G070板子的uart shell移植设计
【福利三:逢7发帖赢大礼】3、基于STM32G070板子的YModem串口协议通信
【福利三:逢7发帖赢大礼】2、基于STM32G070板子的OLED移植U8G2库
微信公众号
手机版