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

基于STM32直流电机中PID的控制

[复制链接]
攻城狮Melo 发布时间:2023-3-18 11:59
一.PID控制算法2 q3 `: I5 K* q: d
1.什么是PID

: A1 ]: l3 p3 v# R1 t. jPID:Proportion-Integral-Differential: q5 y# i7 T. x" d9 T, z- n
6 O/ ~) J' b' B
在过程控制中,我们经常使用的一种算法就是PID算法了,所谓PID控制算法就是对偏差进行比例、积分、微分控制,来使偏差趋于某一固定的值,PID核心由三个单元组成:比例单元(P)、积分单元(I)、微分单元(D),PID实际上就是误差控制。
" T# W3 T, i. \0 @! U

, J- s! y& ~: f4 jPID控制系统(模拟)的框图如下:
6 Q2 w7 g- R) h3 v% `9 ]8 f# i8 }- [( V3 u7 Z3 n) a/ I  M# {
20200428231808887.png
/ q* O6 o- q) L) u8 V$ h1 s; M6 J

5 {% w( l* {% c' o& H0 R! u2.PID系数的理解
! }% z9 s# V0 c# c4 H6 P
理解PID的三个系数,可以结合PID调节时候的响应曲线,要使实际中的响应曲线趋近于理想状态下的响应曲线,无非就是三点灵魂:快速(P)、准确(I)、稳定(D),要想控制的变量保持在完美的状态,这三个灵魂就必须调整好。
3 ^3 Y6 ?$ m3 O; P: Y
1 p( W9 {0 _7 s3 {9 p4 W5 Q以下分析中的:P、I、D都指的是PID的三个系数7 U4 H4 |! G, [
2 h' h$ _8 e$ o/ S4 r0 v
下面从三个系数对整体控制的影响做出分析
, P% y6 A; O, f
! Z! S4 ?9 F' i2 `+ y2 W6 ^5 A
Ⅰ.比例(P)部分$ Q7 k9 i9 i/ H1 }! S) u
输入值一旦与目标值产生偏差e,就需要缩小偏差,P就是用来缩小偏差的,使控制量向减少偏差的方向改变,而且P越大,偏差缩小的速度就越快,所以P的作用就是使控制量更快地接近目标值。! W0 M& ?1 T2 b7 a5 \5 F
% b4 C# w6 s) L( b7 F- @; b& X
但是!十肇九快!!!P过大的时候,就容易刹不住,很容易超出目标值,当超出目标值时,又会反向朝目标值飞奔,然后又太快了,再次偏离目标值,然后又朝目标值…这样反反复复的在目标值附近震荡,这就是P太大的弊端:不够稳定。2 [7 g; V8 Y% e% e5 I# o' y; _+ ^
+ d7 w& b2 H. W2 n0 c0 D) j
所以,P大了虽然可以快速响应,但也容易产生震荡,破坏系统的稳定性,可以适当增大D来提高稳定性。- X6 l" P/ ^$ E! ^0 {4 D# L; u; I
3 ~3 o6 Q0 X$ {* n+ ^

4 `% O" K  k# j- n8 Z# SⅡ.积分(I)部分
1 T; l- g% G4 A积分的表达式如下:
6 k+ S6 ~- D+ m' B! d; w' j% T" ^: C2 J+ ?4 f! N
20200428231837441.png ; b4 v+ W1 o, S8 l3 d( p* d

+ I% S  b. v9 H! B- p9 E# q
从其表达式中可以看出,只要存在偏差,积分结果就会不断增加,也就是控制作用会不断增加;当偏差为0时,积分结果是一个常数,此时控制作用才可能是一个稳定的值。
! u1 s+ j# Z" d" v; O$ G# u2 B+ e+ L; y* u
所以直观的来看,积分可以消除系统的静态偏差,因为一旦有误差,积分就会增加,系统就会做出反应,直到偏差为0,也就是积分保证了控制的准确性。2 A  b& C4 P7 A4 Q

' S5 `2 y) K% H% U. w/ L
积分的作用虽然会消除静态偏差,但是也会拉低系统的响应速度,就是说I对P有抑制作用。
/ h  a  J/ v5 O/ c, k$ f" W, e( Z: v0 ~. L7 D) N  b: ]

, y8 i+ p' ?: w5 EⅢ.微分(D)部分
8 `) U, @9 @3 d  o* m- ?$ n% ~# Z上面说了,P过大会引起震荡,降低系统稳定性,可以通过提高D来减小震荡。+ E+ w; J- B) G  O6 M- |
+ B$ P" ?) T9 O; K/ a5 b
微分的作用就是根据偏差的变化趋势预先给出纠正!怎么个预先法呢?因为微分可以看作是求导,上过高中同鞋都知道:求导可以反映函数的变化趋势。所以,通过微分,可以对偏差的变化进行预判地抑制,防止 矫枉过。8 I  R( n+ [3 `4 f% m9 J: Q. Z

8 |% L6 r) z4 p  G, P
微分的引入,有助于减小震荡,使系统趋于稳定,D越大,抑制P的效果就越强。' H; T4 O1 y7 N  h4 W

/ M* z1 X/ q+ ~2 Y7 v
3 i) E% X! t& Y8 o0 u. m- A" u% O6 f/ S
3.PID的数字化处理9 j9 w6 p. R) I7 Q* ~' B; q/ Y) S
由于计算机控制是一种采样控制,只能根据采样时刻的偏差值计算控制量,所以我们是通过软件实现控制算法的,要对PID进行离散化处理(也就是数字化处理),就是根据离散采样点的偏差值进行控制,在离散化处理后,相比于模拟控制由如下改变:
/ t$ d, ^; r( R) b9 Z6 L, s由差分代替微分
* _" S4 a2 h7 [; e9 Q- C由累加代替积分
9 E$ w9 C  v* d. l& M( z0 q
数字化处理后的PID系统如下:- U; W' i( V) P) Z4 }4 k! i* s

2 x* \. b+ q" [9 h- m. Z# I
20200428231857511.png
' X7 c# `  V0 E

4 d& V* U. |) X采样的周期越小,就越接近模拟控制,控制的效果也就越好。
# J. a/ P6 K* [1 z. s" i9 X
; v  g7 L; Z& ?% L0 {- @
/ n$ t8 v' a! c5 }6 B1 b
二.位置闭环控制9 H. Q$ I% i9 m. T% A! O
位置闭环控制,也叫位置式PID控制,就是传统的PID控制,控制的偏差逐渐接近0,从而使控制量趋于目标值。
/ f* X7 L) ?8 Z5 C+ k! u

9 U! F, J" B4 }& B! S! o1 R+ C对电机使用位置闭环控制的时候,就是控制电机的转动位置,通过编码器的脉冲累加测量电机的位置信息,与目标位置进行比较,得到偏差值,通过比例、积分、微分的PID算法进行控制,使偏差趋于0。
9 v( l: V% p8 q
( O: {, X6 s2 S4 V, N电机控制中,输出量就是电机控制模块输出的占空比,作用于电机转速,此时离散PID的公式如下:
& X. u. ^! {" d
. H& @. R2 @1 a! |1 V
20200428231914180.png 2 p  `0 r7 a' O7 \! ^

' e; g  Z* r; o5 R( R3 [) G2 @0 k其控制框图如下:! y" T) M" f0 e0 ?& F6 d2 w

1 d! E, {6 d8 f: I2 o1 e7 T- Q% J. g
2020042823193183.png
5 B0 m0 m& L2 Z" @
* H4 _+ U5 A2 X) l/ L( \! D# l! W# p" U7 Q控制实现代码如下:
" B$ _1 G2 s; @' @
  1. /* 返回输出: y4 t7 t6 i9 h- M! ]) k$ p+ i
  2. *  Encoder为输入(编码器测量的信号,也就是电机转速)
    & D, X  u6 u2 q1 P
  3. *  Target为目标值
    : S  F7 Z9 a0 Q8 I# n7 L7 {1 t2 P
  4. */+ `5 P9 W0 {! j$ X3 g: H0 x, Q
  5. //KP、KI、KD为PID的系数6 g3 S$ T: F5 x' {7 O# U
  6. int Postition_PID( int Encoder, int Target )
    " K+ A4 R: w$ f) z! i- |
  7. {        //依次的变量代表:偏差、输出、偏差积分、偏差微分
    6 M; a+ d. @0 D
  8.         static float Bias,Pwm,Integral_bias,Last_bias;  ) L9 |+ u! ]- k. r7 w
  9.     Bias = Encoder-Target;//计算偏差
    7 g) m' o9 y$ D9 j5 H- g% @
  10.     Integral_bias += Bias;//计算偏差积分,累加8 \: f  z* ]7 t* {7 w
  11.     Pwm = KP*Bias+KI*Integral_bias+KD*(Bias-Last_bias);//计算输出,根据PID
    : n5 R3 O0 ]. O# G4 W
  12.     Last_bias = Bias;//保存为上一次偏差  n  j( C' R( m( x3 n0 M
  13.     return Pwm;//返回输出
    ' e. Z. Y! N0 w* p& {: R
  14. }/ o1 \- \, g6 H+ z

  15. 5 h9 K3 ~2 ^. u% T+ d
复制代码

0 D8 r& G' x# M0 {5 V3 r% I在定时中断里实现PID控制,定时中断相当于离散的采样点,中断服务函数中可调用控制函数:* [  N8 p% h# |2 C; s5 V( q+ z5 j
  1. //中断中如下调用
    : S& j* z7 m! j+ I0 L2 v: e
  2. Moto = Postition_PID( Encoder, Target );# [2 Y, w. |; t9 n* v! E9 H  ]
  3. //最终的控制落回到控制电机转速上) T7 G7 X2 K' |
  4. Set_Pwm( Moto );3 x1 Z6 C8 v# Q% Y8 Y/ d( l; W
复制代码
! z5 `; D) L- `# @" V2 A
最终的控制要落回到电机的控制上,也就是电机的转速控制——PWM控制。" u' j" r4 d/ x! d3 {4 H# F* y

8 d2 C& C7 y) d位置控制的调节经验:先只使用P控制,逐渐增大P,系统震荡后加入微分控制D来抑制震荡,调整KD直至消除震荡,之后再根据系统对响应和静差的要求,调节P、I参数。
. g0 d5 e; n+ i2 I4 r3 ^' }' r5 }: a
" H: x- g. O( E4 v- q9 L& r
三.速度闭环控制
' x3 D* x" [9 Y7 q
速度闭环控制也可叫增量式PID控制,与位置式PID控制不同,位置式PID输出的是控制量新的状态,而增量式PID输出的是控制量的增值,增量式PID的离散公式如下:
4 _8 c/ y! h% h. Z$ n4 b
* y1 O5 v3 d1 c7 R& d% v
20200428232012760.png
+ d1 y+ M& g, Q2 Y" ?( C1 q7 z3 v. X1 o! z$ F

4 J3 j( H4 I7 X1 F: ^) F位置闭环控制是使电机准确转到某一位置,速度闭环控制是使电机以某一速度转动,在速度闭环控制里,我们只需要使用PI控制即可,所以简化后的公式如下:
+ i3 o! |1 V8 E& I5 ~( f. D
( ~, I7 X( j( b' c/ h, o
20200428232038432.png
  A/ f/ U( h. p- w注意:公式直接将控制量的增量加在上一次控制量的状态上了!!!9 s7 G1 _! s$ G. W- e$ e. R8 z3 j

; `3 A: F* j2 g$ T

4 k0 a' W3 `! L1 T" S+ m控制框图如下:7 V/ t/ }: t+ {. M: t3 W

4 i+ n* f& J- x, a0 E
20200428232053460.png $ P9 X+ G$ f& |; Z3 ^' @

, s8 D6 s; d7 e- B4 \/ i

% V- ]" ^. d0 y控制代码如下:/ v6 `  E+ e$ i& G( |( K, I
  1. /* 返回输出
    - D# g6 f5 W# j* V
  2. *  Encoder为输入(编码器测量的信号,也就是电机转速); a& o5 v- E1 G( O: x* l4 P( x
  3. *  Target为目标值
    1 z! c. {1 L! c1 f# F5 a
  4. */% r5 X8 c. g1 G9 H7 ^+ N7 v
  5. //KP、KI为PID的系数# C. g2 Q9 V- ?/ m- C
  6. int Incremental_PI( int Encoder, int Target )
    8 t5 D- ?; Z- ]
  7. {        //依次的变量代表:偏差、输出、偏差微分
    0 v$ j0 u: J) N# |+ }+ e
  8.         static float Bias,Pwm,Last_bias;  
    ) z2 ~, e1 C4 S) ~
  9.     Bias = Encoder-Target;//计算偏差- f9 u1 W+ p$ t5 f
  10.     Pwm += KP*(Bias-Last_bias)+KI*Bias;//增量式PI* @7 R' `% ]5 X0 \3 p6 d9 u
  11.     Last_bias = Bias;//保存为上一次偏差
    6 N' P  m7 i. d* \1 |$ O- D
  12.     return Pwm;//返回输出
    * ?$ f( {! P3 z/ v% v
  13. }
    0 c1 W2 s0 G) P* g/ b8 S
复制代码

& Y1 b6 B8 z+ L( ?/ D$ P* F3 D4 I在定时中断里实现PID控制,定时中断相当于离散的采样点,中断服务函数中可调用控制函数:
: ?5 X8 `: l' V
  1. //中断中如下调用6 D2 u8 n, W. o2 f" Z7 k- W
  2. Moto = Incremental_PI( Encoder, Target );& a( [9 A% Z2 s- E
  3. //最终的控制落回到控制电机转速上+ c8 o7 c; p' k% w0 {/ S
  4. Set_Pwm( Moto );5 Q8 f4 V& |) C. J. y
复制代码

6 U8 [1 O& ]4 t1 K7 D要注意速度闭环控制采用PI控制,公式与PID有所不同,输出的也是控制量的增量,这里将增量直接加在了上一次的状态量上,所以输出的还是控制量的新状态。5 y( ]% ^! z! `, x# `/ A

; M8 \- P5 L3 n! H8 ~最后附上我找到的PID参数调整口诀:
) l. o0 `' F% V( Y4 p5 s! _/ I: V  u2 N: E! H1 k; u+ B1 z% n
常用口诀:: C/ g( Y# m0 x) @9 o
参数整定找最佳,从小到大顺序查! ^% `' T, v+ g0 r
先是比例后积分,最后再把微分加$ w+ D2 r) R. I, a8 T
曲线振荡很频繁,比例度盘要放大8 D+ }# L+ _; u
曲线漂浮绕大湾,比例度盘往小扳
% l/ h0 c; j+ Z2 V3 J曲线偏离回复慢,积分时间往下降; A' B+ k- z* R' I7 E9 Y
曲线波动周期长,积分时间再加长
% `& t" e) ~" B' p% _" c6 g曲线振荡频率快,先把微分降下来8 U( Z& W! E9 A5 |: V$ m; c
动差大来波动慢。微分时间应加长
6 ~7 x7 q0 a2 V- {# y- a) p( y理想曲线两个波,前高后低4比19 Q) c8 C" ^: h5 T, w+ f- ~
一看二调多分析,调节质量不会低
% H$ Q: N! n+ L4 L: t& `0 }+ D2 R————————————————/ F% R" v- I$ J% }5 ^4 w
版权声明:Aspirant-GQ. j, ?. P% o5 k6 \+ V6 [% |
如有侵权请联系删除4 p' {1 M4 @: [5 ?* u0 X8 G6 Y
" U% s7 o5 e3 @

) E4 R1 {$ K; V+ _' t0 q: I+ k& ^, \% c2 }' B* |2 l8 i
赞 收藏 评论1 发布时间:2023-3-18 11:59

举报

1个回答
Panto 回答时间:2023-4-13 05:44:42

"PID control is implemented in the timing interrupt"

How often ?

Is it related with motor speed ?

Thanks

所属标签

相似技术帖

官网相关资源

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