你的浏览器版本过低,可能导致网站不能正常访问!
为了你能正常使用网站功能,请使用这些浏览器。

【经验分享】如何在STM32上实现增量式PID转

[复制链接]
STMCU小助手 发布时间:2022-1-7 20:11
虽然PID不是什么牛逼的东西,但是真心希望以后刚刚接触这块的人能尽快进入状态。特地分享一些自己如何实现的过程。
! f- I' P, }6 m首先说说增量式PID的公式,这个关系到MCU算法公式的书写,实际上两个公式的写法是同一个公式变换来得,不同的是系数的差异。
  e1 O5 R4 Z& u: s- r& C资料上比较多的是:
/ a4 ~+ q% v+ s% Y0 d. m$ i2 r/ X7 |" u2 c, x- O5 Z3 t
  H4 g3 k& h' z# Y5 y2 O
还有一种的算法是:
3 i. s. `* p  {7 q/ X, l1 |% T2 o7 p# z8 o" f5 k5 X. C2 y4 l
! X6 ^7 _/ U3 D
这里主要介绍第二种,具体会分析比例、积分、微分三个环节的作用。
9 i! f" d. r9 C6 ~8 @
+ C: F# z2 t% N$ [) a: g8 @硬件部分:
  T, v4 A  ?$ O0 d$ i控制系统的控制对象是4个空心杯直流电机,电机带光电编码器,可以反馈转速大小的波形。电机驱动模块是普通的L298N模块。6 ^' }! }& M, b, G" ]2 q2 O
芯片型号,STM32F103ZET60 m* U9 y8 h, B# H) G- [* R( m$ _
! F2 A0 h  }8 j* \# }/ {
软件部分:
0 L+ _5 @% |/ V# i3 PPWM输出:tiM3,可以直接输出4路不通占空比的PWM波) E4 R! V+ c: C/ G
PWM捕获:STM32除了TIM6 TIM7其余的都有捕获功能,使用TIM1 TIM2 TIM4 TIM5四个定时器捕获四个反馈信号, S  d) |" ~- {& N6 J% J: D9 N; M
PID的采样和处理:使用了基本定时器TIM6,溢出时间就是我的采样周期,理论上T越小效果会越好,这里我取20ms,依据控制对象吧,如果控制水温什么的采样周期会是几秒几分钟什么的。
2 K  l6 V1 |% S
2 H" d7 K% {) e& |上面的PWM输出和捕获关于定时器的设置都有例程,我这里是这样的:
4 _# ]# |8 X1 M$ K* v9 c( STIM3输出四路PWM,在引脚 C 的 GPIO_Pin_6 | GPIO_Pin_7 | GPIO_Pin_8 | GPIO_Pin_9输出
6 Q, j4 \( D/ a# Y: j" \四路捕获分别是TIM4  TIM1  TIM2  TIM5   ,对应引脚是:  PB7 PE11 PB3 PA10 @. I% C( e9 ^; y) ^
高级定时器tim1的初始化略不同,它的中断”名称“和通用定时器不同。具体的内容,请大家看一下我分享的代码就明白了。% r5 t4 S8 Z( e3 F/ A5 x- B
游客,如果您要查看本帖隐藏内容请回复
0 k& _8 K, I# f0 s* x- i* j  b1 q9 l. K0 m/ ?

' M, o6 H! Z( c( K  v
$ H3 J( D+ n' H' p/ D! P  T- D7 Z* @/ p- R4 m  H0 p" F! U
主要讲解PID部分7 Z( L% [; B; B7 ?; B% l' p7 o7 [
准备部分:先定义PID结构体:9 |! H- ?. @- E7 R. x2 c6 B
  • typedef struct
  • {
  • int setpoint;//设定目标
  • int sum_error;//误差累计
  • float proportion ;//比例常数
  • float integral ;//积分常数
  • float derivative;//微分常数
  • int last_error;//e[-1]
  • int prev_error;//e[-2]
  • }PIDtypedef;
    % ~7 d$ d- b  O: y5 p( b/ F

8 R+ R/ C. J1 @3 b* c: r复制代码

: s! P  D( J6 z7 H$ }1 F在文件中定义几个关键变量:9 O/ b' `1 M. l' W: b& x" T
  • float  Kp =     0.32  ; //比例常数
  • float  Ti =                0.09 ; //积分时间常数
  • float Td =                0.0028 ;  //微分时间常数
  • #define T                  0.02 //采样周期
  • #define Ki     Kp*(T/Ti)        // Kp Ki Kd 三个主要参数
  • #define Kd                Kp*(Td/T)
    ; [6 ]7 x0 t5 ~  `+ O. c/ ~
7 G3 h' |# k7 ~3 s
[color=rgb(51, 102, 153) !important]复制代码

% a. c5 V9 Z$ @1 u8 {" B" d1 JPID.H里面主要的几个函数:6 s9 r1 V( K7 \, C
  • void PIDperiodinit(u16 arr,u16 psc);        //PID 采样定时器设定
  • void incPIDinit(void);                //初始化,参数清零清零
  • int incPIDcalc(PIDtypedef*PIDx,u16 nextpoint);           //PID计算
  • void PID_setpoint(PIDtypedef*PIDx,u16 setvalue);  //设定 PID预期值
  • void PID_set(float pp,float ii,float dd);//设定PID  kp ki kd三个参数
  • void set_speed(float W1,float W2,float W3,float W4);//设定四个电机的目标转速6 V; {5 l6 H1 T. T  m
- H& t$ I: w' X' w
[color=rgb(51, 102, 153) !important]复制代码

0 B2 d$ J/ ^5 M9 A  |, i
, K# ~9 S/ w+ f7 WPID处理过程:
/ i  n! a1 [# B% A1 K岔开一下:这里我控制的是电机的转速w,实际上电机的反馈波形的频率f、电机转速w、控制信号PWM的占空比a三者是大致线性的正比的关系,这里强调这个的目的是! ^) G: S1 u. O1 i. Y1 M
因为楼主在前期一直搞不懂我控制的转速怎么和TIM4输出的PWM的占空比联系起来,后来想清楚里面的联系之后通过公式把各个系数算出来了。  B' S7 d5 B& [1 C7 I3 P$ X
- A6 M3 r9 x: Q$ {& m/ ]; O
正题:控制流程是这样的,首先我设定我需要的车速(对应四个轮子的转速),然后PID就是开始响应了,它先采样电机转速,得到偏差值E,带入PID计算公式,得到调整量也就是最终更改了PWM的占空比,不断调节,直到转速在稳态的一个小范围上下浮动。) b. z! D, e# h8 z3 O3 E& O
上面讲到的“得到调整量”就是增量PID的公式:: |9 G$ ~# T3 ^8 i* p" J1 L
  • int incPIDcalc(PIDtypedef *PIDx,u16 nextpoint)
  • {
  • int iError,iincpid;
  • iError=PIDx->setpoint-nextpoint;  //当前误差
  • /*iincpid=                                               //增量计算
  • PIDx->proportion*iError                //e[k]项
  • -PIDx->integral*PIDx->last_error          //e[k-1]
  • +PIDx->derivative*PIDx->prev_error;//e[k-2]
  • */
  • iincpid=                                                          //增量计算
  • PIDx->proportion*(iError-PIDx->last_error)
  • +PIDx->integral*iError
  • +PIDx->derivative*(iError-2*PIDx->last_error+PIDx->prev_error);
  • PIDx->prev_error=PIDx->last_error; //存储误差,便于下次计算
  • PIDx->last_error=iError;
  • return(iincpid) ;
  • }0 h2 r' H# B" O

, F' w$ g1 a/ V7 e[color=rgb(51, 102, 153) !important]复制代码

: T7 G5 F2 Z8 |- `8 H注释掉的是第一种写法,没注释的是第二种以Kp KI kd为系数的写法,实际结果是一样的。# Q! v  ~) U& p3 U; c5 ^: E, p
处理过程放在了TIM6,溢出周期时间就是是PID里面采样周期(区分于反馈信号的采样,反馈信号采样是1M的频率)
( x# J4 {3 a/ Y. ^: t4 m相关代码:
6 I, E5 }( w1 x) K0 Z
  • void TIM6_IRQHandler(void)        //        采样时间到,中断处理函数
  • {
  • IF (TIM_GetITStatus(TIM6, TIM_IT_Update) != RESET)//更新中断
  •         {
  •         frequency1=1000000/period_TIM4        ; //通过捕获的波形的周期算出频率
  •         frequency2=1000000/period_TIM1        ;
  •         frequency3=1000000/period_TIM2        ;
  •         frequency4=1000000/period_TIM5        ;
  • /********PID1处理**********/
  •         PID1.sum_error+=(incPIDcalc(&PID1,frequency1));         //计算增量并累加
  •        pwm1=PID1.sum_error*4.6875  ;   //pwm1 代表将要输出PWM的占空比
  •           frequency1=0; //清零
  •      period_TIM4=0;
  • /********PID2处理**********/
  •          PID2.sum_error+=(incPIDcalc(&PID2,frequency2));         //计算增量并累加  Y=Y+Y'
  •          pwm2=PID2.sum_error*4.6875 ;   //将要输出PWM的占空比
  •         frequency2=0;
  •         period_TIM1=0;
  • /********PID3处理**********/
  •          PID3.sum_error+=(incPIDcalc(&PID3,frequency3));          //常规PID控制
  •         pwm3=PID3.sum_error*4.6875 ;   //将要输出PWM的占空比
  •         frequency3=0;
  •         period_TIM2=0;
  • /********PID4处理**********/
  •             PID4.sum_error+=(incPIDcalc(&PID4,frequency4));         //计算增量并累加
  •          pwm4=PID4.sum_error*4.6875 ;   //将要输出PWM的占空比
  •         frequency4=0;
  •         period_TIM5=0;
  •           }
  • TIM_SetCompare(pwm1,pwm2,pwm3,pwm4);             //重新设定PWM值
  • TIM_ClearITPendingBit(TIM6, TIM_IT_Update); //清除中断标志位
  • }
    ; g9 W) H, j; \# k+ D8 f

' Z9 I. C' z- p8 r$ s: q0 b, E[color=rgb(51, 102, 153) !important]复制代码
& S5 {1 l) N. L% [6 m
上面几个代码是PID实现的关键部分/ O0 L( A" v# m& p" R4 @# \
' Y& q9 k/ M: i% _1 g$ k) g: m
还有整定过程:
: t, r3 I5 L. _" z0 _办法有不少,这里用的是先KP,再TI,再TD,在微调。其他的办法特别是有个尼古拉斯法我发现不适合我这个控制对象。  I. A( \0 M) y7 D( l
先Kp,就是消除积分和微分部分的影响,这里我纠结过到底是让Ti 等于一个很大的值让Ki=Kp*(T/Ti)里面的KI接近零,还是直接定义KI=0,TI=0.
8 Y. `9 d' S* V$ Z6 \0 q. b5 g然后发现前者没法找到KP使系统震荡的临界值,第二个办法可以得到预期的效果:即KP大了会产生震荡,小了会让系统稳定下来,当然这个时候是有稳态误差的。8 ~. B9 D1 a1 h
随后把积分部分加进去,KI=Kp*(T/Ti)这个公式用起来,并且不断调节TI 。TI太大系统稳定时间比较长。
) J9 X6 M- z1 k然后加上Kd        =Kp*(Td/T),对于系统响应比较滞后的情况效果好像好一些,我这里的电机反映挺快的,所以Td值很小。( g7 D$ o! k/ l  N
最后就是几个参数调节一下,让波形好看一点。这里的波形实际反映的是采集回来的转速值,用STM32的DAC功能输出和转速对应的电压,用示波器采集的。
) \! x8 G0 v. {8 v7 ~最后的波形是这样的:- x; r8 k/ ?/ h$ f& w
5 w  Y6 X1 \- q% C, c6 ~, _
赞 收藏 评论0 发布时间:2022-1-7 20:11

举报

0个回答

所属标签

相似技术帖

官网相关资源

关于
我们是谁
投资者关系
意法半导体可持续发展举措
创新与技术
意法半导体官网
联系我们
联系ST分支机构
寻找销售人员和分销渠道
社区
媒体中心
活动与培训
隐私策略
隐私策略
Cookies管理
行使您的权利
官方最新发布
人形机器人运动控制、感知与智能配电
半导体创新技术与应用方向
EE架构与软件定义汽车
12V/48V 汽车智能配电(SPD)
区域控制单元(ZCU)与分区架构
关注我们
st-img 微信公众号
st-img 手机版