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

(转载)增量式PID的stm32实现,整定过程

[复制链接]
nyszx 发布时间:2017-12-26 15:40
本帖最后由 nyszx 于 2017-12-26 19:31 编辑 ) Z$ V( k- ^, w, S. l

1 |0 V0 d, f. [8 l6 M" c1 x3 ^7 j原帖:【分享】增量式PID的stm32实现,整定过程
+ S8 ^3 Z* ^7 S. L5 }原文网址:http://www.amobbs.com/thread-5575823-1-1.html. {0 \! T; \1 \$ b5 F5 |
出处:阿莫电子论坛 - `1 [) b6 G' s6 p/ O; ^1 p, v' `
作者:tim4146
: }6 f! Y) ^/ m, S. w* D" O感谢大家最近的帮忙,让我顺利做完增量PID功能,虽然PID不是什么牛逼的东西,但是真心希望以后刚刚接触这块的人能尽快进入状态。
# y. N/ ?* T' I- Q! X也下面我分享一下近期的这些工作吧。欢迎大家批评指点~
1 x9 L5 w" z% y- b  ^6 t3 `
3 f6 y# c4 |1 w  d, s! z: Z" S7 Z首先说说增量式PID的公式,这个关系到MCU算法公式的书写,实际上两个公式的写法是同一个公式变换来得,不同的是系数的差异。: X$ ^: p) J) h( C. G
资料上比较多的是:* |3 m1 k! o/ J* @
1.jpg 4 b5 \* ~; ^" s7 ^1 Y
还有一种是:
- r  T* h( u) N  Z% l  c 2.jpg 3 O/ n* Z. S. C3 |2 z
感觉第二种的Kp Ki Kd比较清楚,更好理解,下面介绍的就以第二种来吧。(比例、积分、微分三个环节的作用这里就详细展开,百度会有很多)0 m  c; W' q; M2 G4 e: i& D6 P& \

" H& q7 J, \/ ^, R4 o' P& p9 u0 }硬件部分:* A+ c5 }" t& C3 u, h) K3 U
控制系统的控制对象是4个空心杯直流电机,电机带光电编码器,可以反馈转速大小的波形。电机驱动模块是普通的L298N模块。# c! [0 _8 y. z8 a9 K  e
芯片型号,STM32F103ZET6
, M6 Z* Y! c8 d: V* h5 f( ^" Q  Q* H
软件部分:* t( ]) S( C2 ~7 r( V" G
PWM输出:TIM3,可以直接输出4路不通占空比的PWM波  K' u! x5 g& V& _+ l* I$ M
PWM捕获:STM32除了TIM6 TIM7其余的都有捕获功能,使用TIM1 TIM2 TIM4 TIM5四个定时器捕获四个反馈信号* N$ }2 \4 W  a# C' P
PID的采样和处理:使用了基本定时器TIM6,溢出时间就是我的采样周期,理论上T越小效果会越好,这里我取20ms,依据控制对象吧,如果控制水温什么的采样周期会是几秒几分钟什么的。
. P) M6 _4 M9 s, o: Z6 ^5 ?% g; k2 s
上面的PWM输出和捕获关于定时器的设置都有例程,我这里是这样的:1 g9 t/ x' ~) S+ m
TIM3输出四路PWM,在引脚 C 的 GPIO_Pin_6 | GPIO_Pin_7 | GPIO_Pin_8 | GPIO_Pin_9输出# |& x; ]1 S" H/ o1 S2 v
四路捕获分别是TIM4  TIM1  TIM2  TIM5   ,对应引脚是:  PB7 PE11 PB3 PA1
4 y0 f! d' i# h9 u3 X
高级定时器tim1的初始化略不同,它的中断”名称“和通用定时器不同,见代码:) `* N, v+ Y+ b7 O+ i
  1. /*功能名称IM3_PWM_Init(u16 arr,u16 psc)
      ?) k* x- C2 M5 H
  2.         描述      TIM3产生四路PWM% }. ~" L+ X+ j1 \" \
  3. */
    * @* X) B3 t6 i, s% h& l
  4. void TIM3_PWM_Init(u16 arr,u16 psc)
    : U2 L6 ~. f: `3 f
  5. {, Q6 P( L% q* I5 E% W7 R& v2 {
  6.         GPIO_InitTypeDef GPIO_InitStructure;
    + \6 F3 _# A- ^7 W
  7.         TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;
    ' D$ m: C  D7 y7 v( O0 Y
  8.         TIM_OCInitTypeDef  TIM_OCInitStructure;% H* P: |* I7 h3 J8 x

  9. ' ?# A5 G! Y' _, U; r2 M
  10. . c$ G' S- g, G0 {0 a. s
  11.         RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE);; ?5 e) l& u5 n' P8 ~' i
  12.          RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC  | RCC_APB2Periph_AFIO, ENABLE);  //使能GPIO外设和AFIO复用功能模块时钟使能: u8 v" }, ^" f; n* B% H$ z# \8 y" H

  13. 5 P9 h: D! F% I" v. h2 G; \0 h9 j
  14.   GPIO_PinRemapConfig(GPIO_FullRemap_TIM3, ENABLE); //Timer3全映射 GPIOC-> 6,7,8,9                                                                             //用于TIM3的CH2输出的PWM通过该LED显示
    . U1 M6 F/ U. L" o& R8 n
  15. 7 i6 J7 E+ z2 V
  16.    //设置该引脚为复用输出功能,输出TIM3 CH1 CH2 CH3 CH4 的PWM脉冲波形' _0 j7 A2 r" _3 W  M/ J% _
  17.         GPIO_InitStructure.GPIO_Pin =GPIO_Pin_6 | GPIO_Pin_7 | GPIO_Pin_8 | GPIO_Pin_9; //初始化GPIO
    ; A4 u! Y/ `2 o
  18.         GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;  //复用推挽输出
    + w6 j: k) k5 J* W
  19.         GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
    7 n9 K) j; U' C( |7 V* R7 y
  20.         GPIO_Init(GPIOC, &GPIO_InitStructure);5 F' r7 i, Z# k
  21.         GPIO_ResetBits(GPIOC,GPIO_Pin_6 | GPIO_Pin_7 | GPIO_Pin_8 | GPIO_Pin_9);//默认电机使能端状态:不使能
    6 [+ q6 k3 ~* y/ [
  22. / H9 b0 D1 W0 `
  23.         TIM_TimeBaseStructure.TIM_Period = arr; //设置在下一个更新事件装入活动的自动重装载寄存器周期的值
    - A  t1 t& Z4 e& o
  24.         TIM_TimeBaseStructure.TIM_Prescaler =psc; //设置用来作为TIMx时钟频率除数的预分频值  这里是72分频,那么时钟频率就是1M
    % o6 ]5 ?  g) Z) G
  25.         TIM_TimeBaseStructure.TIM_ClockDivision = 0; //设置时钟分割:TDTS = Tck_tim
    9 ?* k. |& ]0 H2 d
  26.         TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;  //TIM向上计数模式, ]7 d9 Y; N) k' G) ~' T
  27.         TIM_TimeBaseInit(TIM3, &TIM_TimeBaseStructure); //根据TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位
    0 ?* u0 [4 l  y3 L: {- J; ?

  28.   _' R2 U* o/ S6 \* ]4 ^/ T
  29. . ~* Q0 D" [5 R" m* K
  30.         TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1; //选择定时器模式:TIM脉冲宽度调制模式1
    . `$ `& X( G" g  @: x  Q8 b$ `
  31.         TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable; //比较输出使能$ o* h8 x. s5 O  l
  32.         TIM_OCInitStructure.TIM_Pulse = 0; //设置待装入捕获比较寄存器的脉冲值
    " A8 P" C. S" [& S* C" Q
  33.         TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High; //输出极性:TIM输出比较极性高% D4 `  z8 w% x, k: `

  34. ' {9 V# ^1 Q" }1 S
  35.         TIM_OC1Init(TIM3, &TIM_OCInitStructure);  //根据TIM_OCInitStruct中指定的参数初始化外设TIMx* I4 b) s" @/ Z2 B& X
  36.         TIM_OC1PreloadConfig(TIM3, TIM_OCPreload_Enable);  //使能TIMx在CCR1上的预装载寄存器' s  O/ ^5 M+ C. q" J. |7 y) T
  37. : T' w  j+ c) Y5 N- O' q! K0 |
  38. ' q- }5 R. [5 z/ h
  39.         TIM_OC2Init(TIM3, &TIM_OCInitStructure);  //根据TIM_OCInitStruct中指定的参数初始化外设TIMx$ B  h4 C8 a' ?3 ^) F, v
  40.         TIM_OC2PreloadConfig(TIM3, TIM_OCPreload_Enable);  //使能TIMx在CCR2上的预装载寄存器7 l6 }5 D8 [2 I

  41. 6 w8 |  M9 c. i1 J
  42.         TIM_OC3Init(TIM3, &TIM_OCInitStructure);  //根据TIM_OCInitStruct中指定的参数初始化外设TIMx+ J0 Y1 _1 g  I! M  c$ u2 M
  43.         TIM_OC3PreloadConfig(TIM3, TIM_OCPreload_Enable);  //使能TIMx在CCR3上的预装载寄存器5 U/ C* \) s  z* q
  44. 0 c. g/ J0 D3 }% C, r+ \1 |# W* c
  45.         TIM_OC4Init(TIM3, &TIM_OCInitStructure);  //根据TIM_OCInitStruct中指定的参数初始化外设TIMx
    / V( v& y' `' [( w: ]( n2 |1 r
  46.         TIM_OC4PreloadConfig(TIM3, TIM_OCPreload_Enable);  //使能TIMx在CCR4上的预装载寄存器
    1 e$ L, [, G2 i0 V8 i

  47. ; |, v7 h+ I4 e( Y2 m$ r! p
  48.         TIM_ARRPreloadConfig(TIM3, ENABLE); //使能TIMx在ARR上的预装载寄存器
    3 N' f& {! f' j3 n0 x, n+ ?

  49. ' M+ @! A7 W9 j- U4 c! a
  50. 9 l6 ?( ~7 \# S+ @/ s1 H
  51.         TIM_Cmd(TIM3, ENABLE);  //使能TIMx外设' g/ F+ ^: H, y7 H7 H' y

  52. 3 b: m( N6 `& W/ }
  53. ( u8 L( h- r; v2 E" X/ f
  54. }! L: U9 g  N; j: U* S! L( v

  55. * w0 w# D9 J( l  F' I4 O2 f

  56. - i( F/ O; _# ^  l- T
  57. 1 y# [& q, ]& j, ?0 f8 ~: o! ~) X
  58. /*功能名称TIM4_PWMINPUT_INIT(u16 arr,u16 psc)- V9 G5 J1 _- P! u. [' d( _
  59.   描述      PWM输入初始化*/" h/ N. q, ~/ V, F8 [# M3 b
  60. ( e" Y+ r; u- Z/ K; z9 b
  61. void TIM4_PWMINPUT_INIT(u16 arr,u16 psc)6 Q% S1 S0 f- b+ e0 i+ J, s5 O
  62. {
    4 {9 \9 I7 M2 s# D) A* x

  63. 2 P) P/ a% Q  ^3 F- ]+ ]
  64.         TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;        //TIM的初始化结构体3 {8 `/ E8 m/ U8 ~" {9 @; v
  65.         NVIC_InitTypeDef NVIC_InitStructure;                        //中断配置& {: d/ ]2 z+ i+ R
  66.         TIM_ICInitTypeDef  TIM4_ICInitStructure;                 //TIM4  PWM配置结构体* z/ A9 ?* Q( ?$ H$ D; k
  67.         GPIO_InitTypeDef GPIO_InitStructure;                         //IO口配置结构体! L( [. @7 s% m! f+ N

  68. % O. S2 R( k1 A" f5 `- R( }  O; o
  69.         RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM4, ENABLE);     //Open TIM4 clock7 X2 ^1 g! w6 |, S5 {# {1 G
  70.   RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB, ENABLE);  //open gpioB clock. s$ D% B  i( \

  71. & M  k4 _0 x& ?# b6 x
  72.         GPIO_InitStructure.GPIO_Pin = GPIO_Pin_7;             //GPIO 7$ a( z. l4 [) s9 q1 v- @/ ?
  73.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU;          //上拉输入
    # ?* c5 R2 e- X2 [
  74.   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;( I) f4 S9 B  p! v# _0 A1 X
  75.   GPIO_Init(GPIOB, &GPIO_InitStructure);; T# \& K" z1 x2 U1 {8 R
  76. : E. f# u4 K% k$ @$ k. i; G1 h$ x  c
  77.         TIM_TimeBaseStructure.TIM_Period = arr; //设置在下一个更新事件装入活动的自动重装载寄存器周期的值* N) T# j" B( J, }4 ]$ @' C
  78.         TIM_TimeBaseStructure.TIM_Prescaler =psc; //设置用来作为TIMx时钟频率除数的预分频值. o" O4 [" W6 L1 e4 e- Z5 ~
  79.         TIM_TimeBaseStructure.TIM_ClockDivision = 0; //设置时钟分割:TDTS = Tck_tim1 S, c  V) A7 a1 z- B/ @) H9 ]
  80.         TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;  //TIM向上计数模式: n9 r3 @: Y8 }5 I0 X
  81.         TIM_TimeBaseInit(TIM4, &TIM_TimeBaseStructure); //根据TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位
    5 U0 i. K. e5 {7 Z

  82. 6 Y3 b& i) R# i  h5 C" @8 ]$ V
  83. 5 V' a6 j/ g/ H/ o6 h* |% T
  84.         /*配置中断优先级*/
    ) k% U2 ]1 n; q% g7 a; N8 d
  85.         NVIC_InitStructure.NVIC_IRQChannel = TIM4_IRQn;. [8 A* |& U4 Z+ v, [7 R
  86.   NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 1;# _9 r% X0 X# ^4 Z' k
  87.   NVIC_InitStructure.NVIC_IRQChannelSubPriority = 1;/ R4 o1 C# S4 d" f$ p8 h
  88.   NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
    ' I- C6 K3 k3 `" M3 s# ]- ^
  89.   NVIC_Init(&NVIC_InitStructure);- D- {% N# [* I$ f
  90. 4 o. f' s* D0 K- O! G% n  U
  91.   TIM4_ICInitStructure.TIM_Channel = TIM_Channel_2;
    * }1 ]+ L5 i7 q' c
  92.   TIM4_ICInitStructure.TIM_ICPolarity = TIM_ICPolarity_Rising;+ t4 |! @% u+ c" C
  93.   TIM4_ICInitStructure.TIM_ICSelection = TIM_ICSelection_DirectTI;
    / n1 |1 m) N9 @9 J; J
  94.   TIM4_ICInitStructure.TIM_ICPrescaler = TIM_ICPSC_DIV1;/ B' y3 a0 l( c) q) G5 f
  95.   TIM4_ICInitStructure.TIM_ICFilter = 0x3;   //Filter:过滤/ A# ]9 `9 e- P8 t: J, z; B; g
  96. ) `! }$ c! [; O% s! x$ ?4 O0 j
  97.   TIM_PWMIConfig(TIM4, &TIM4_ICInitStructure);     //PWM输入配置( |. O. T" ~- X
  98.   TIM_SelectInputTrigger(TIM4, TIM_TS_TI2FP2);     //选择有效输入端
    - ]* ~/ K7 Y% K9 G5 J" m
  99.   TIM_SelectSlaveMode(TIM4, TIM_SlaveMode_Reset);  //配置为主从复位模式, L! g; @$ w  X5 P% y$ f
  100.   TIM_SelectMasterSlaveMode(TIM4, TIM_MasterSlaveMode_Enable);//启动定时器的被动触发
    3 ~0 h: J/ D4 w+ [$ \$ q
  101.   TIM_ITConfig(TIM4, TIM_IT_CC2|TIM_IT_Update, ENABLE);          //中断配置
    ' z9 I& D% p. e" t3 w4 |
  102.   TIM_ClearITPendingBit(TIM4, TIM_IT_CC2|TIM_IT_Update); //清除中断标志位, p. F6 o) i* r/ |& y
  103.   TIM_Cmd(TIM4, ENABLE);) p/ K4 |- ^5 R/ J
  104. }
    ) b& w  c! o" b* `$ x: [8 r5 C
  105. : s/ N5 {2 X. J9 S! Q

  106. 5 t, l: u# r; {/ B4 n
  107. void TIM4_IRQHandler(void)
    9 e" K% T+ h* t2 e4 S. {5 F7 p
  108. {
    3 c8 t+ H5 T' h- ^

  109. # y7 Q% Y* _4 Z
  110.                 if (TIM_GetITStatus(TIM4, TIM_IT_CC2) != RESET)//捕获1发生捕获事件8 n7 E- A: }) E" K& e2 H' k6 t+ L
  111.                         {% C+ _: A  C6 X
  112.                                 duty_TIM4    =   TIM_GetCapture1(TIM4);          //采集占空比8 P; U! D8 H1 l4 y" a
  113.                if  (TIM_GetCapture2(TIM4)>600)         period_TIM4        =        TIM_GetCapture2(TIM4);//简单的处理
    - c+ \5 y8 w8 h6 L8 V  P
  114.                                 CollectFlag_TIM4 = 0;
    # }, Y0 X% e" L# _
  115.         }5 ^7 d2 [1 S7 Q5 Q* S
  116.                 TIM_ClearITPendingBit(TIM4, TIM_IT_CC2|TIM_IT_Update); //清除中断标志位8 j% `3 p: i+ k; |% n# }# ]
  117. }! i$ Y3 d; c/ r9 a; @! ^
  118. - u" n" U7 Y5 D$ t$ C( L
  119. 6 x9 j" F9 x1 Z( ~! U& q
  120. /*功能名称TIM1_PWMINPUT_INIT(u16 arr,u16 psc)% R& U8 \/ d0 G* \( ~
  121.   描述      PWM输入初始化*/
    * @# x* f& |* D9 }' W: c

  122. 1 {3 l/ k! H" |: \
  123. void TIM1_PWMINPUT_INIT(u16 arr,u16 psc)
    6 c' }) m1 C( a
  124. {  \+ W4 M/ {' L" L. r3 |5 B/ q' T/ u6 O
  125. 8 k# `3 Z% d7 H1 r2 L! S4 F9 L2 a
  126.         TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;        //TIM的初始化结构体
    - C5 k  o) r7 E3 o. D1 `
  127.         NVIC_InitTypeDef NVIC_InitStructure;                        //中断配置
    0 s3 D% V! Z& d) u. _+ |* n8 m
  128.         TIM_ICInitTypeDef  TIM1_ICInitStructure;                 //PWM配置结构体0 y# Z% [  d/ o% \: z, u
  129.         GPIO_InitTypeDef GPIO_InitStructure;                         //IO口配置结构体
    # u* |* \+ ^6 \  l6 {; ]' M+ r

  130. ' [0 U/ z- _- m" n
  131.         RCC_APB2PeriphClockCmd(RCC_APB2Periph_TIM1, ENABLE);     //Open TIM1 clock
    7 k7 o1 e6 ]1 o# q" d( a8 v
  132.   RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOE, ENABLE);  //open gpioE clock
    # o9 ~7 Q* p8 ]( z- Y# z
  133.    GPIO_PinRemapConfig(GPIO_FullRemap_TIM1, ENABLE); //Timer1完全重映射  TIM1_CH2->PE11
    - U3 o6 b4 D7 h9 T9 U/ ]
  134.         GPIO_InitStructure.GPIO_Pin = GPIO_Pin_11;             //GPIO 11
    2 h0 I  _+ {" a5 n' R1 f
  135.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU;          //上拉输入0 y$ o, `2 ^# P, n  a
  136.   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;  D& }1 r! I6 R/ c% u
  137.   GPIO_Init(GPIOE, &GPIO_InitStructure);
    8 R  D/ _$ |5 ]2 Y0 b) ?- r7 X

  138. 9 b% S' r. s2 u' t- }" F
  139.         TIM_TimeBaseStructure.TIM_Period = arr; //设置在下一个更新事件装入活动的自动重装载寄存器周期的值! ^& @% e5 B# @4 i8 M0 ]
  140.         TIM_TimeBaseStructure.TIM_Prescaler =psc; //设置用来作为TIMx时钟频率除数的预分频值
    $ h3 `+ `* i3 d$ x
  141.         TIM_TimeBaseStructure.TIM_ClockDivision = 0; //设置时钟分割:TDTS = Tck_tim1 ^4 t6 m' R/ P5 }1 v6 `1 a& C
  142.         TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;  //TIM向上计数模式% g6 w5 `1 \( [( Z  X' d
  143.         TIM_TimeBaseInit(TIM1, &TIM_TimeBaseStructure); //根据TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位$ X: e3 q: ]4 f! k3 f, e& P" F

  144. * ~  C+ t, E) x" \. A( p/ y* S

  145. ) {+ X! G4 A0 n5 v5 ^* z
  146.         /*配置中断优先级*/
    1 p! `3 w$ p0 Z+ u
  147.   NVIC_InitStructure.NVIC_IRQChannel =  TIM1_CC_IRQn;   //TIM1捕获中断
      y) g/ a" T) _7 \" |
  148.   NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 1;" V; r5 N  D# y' u- {1 ?* t
  149.   NVIC_InitStructure.NVIC_IRQChannelSubPriority = 1;2 `4 ^/ F1 \- q
  150.   NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;! S2 J* O9 [9 T. _; b3 v
  151.   NVIC_Init(&NVIC_InitStructure);5 y9 }# H8 I: C5 v
  152. 5 y; s! `! ^! q6 w8 `
  153.   TIM1_ICInitStructure.TIM_Channel = TIM_Channel_2;
    3 J# t. K) ?+ H- P0 @
  154.   TIM1_ICInitStructure.TIM_ICPolarity = TIM_ICPolarity_Rising;
    + k2 N: B, g9 q' _- F3 a
  155.   TIM1_ICInitStructure.TIM_ICSelection = TIM_ICSelection_DirectTI;1 _6 U. c% u. g; L
  156.   TIM1_ICInitStructure.TIM_ICPrescaler = TIM_ICPSC_DIV1;
    ( Q: ~1 X3 V6 v- |0 T+ i
  157.   TIM1_ICInitStructure.TIM_ICFilter = 0x03;   //Filter:过滤( e' D9 P2 ]- @6 ]
  158. 4 G+ A1 w0 ]: \2 g% S9 e
  159.   TIM_PWMIConfig(TIM1, &TIM1_ICInitStructure);     //PWM输入配置
    . }! t/ ], K* w% N
  160.   TIM_SelectInputTrigger(TIM1, TIM_TS_TI2FP2);     //选择有效输入端
    : s5 e8 @4 `9 g% d" r5 H1 ^
  161.   TIM_SelectSlaveMode(TIM1, TIM_SlaveMode_Reset);  //配置为主从复位模式
    / Y' v3 |! n" x; [: F, J
  162.   TIM_SelectMasterSlaveMode(TIM1, TIM_MasterSlaveMode_Enable);//启动定时器的被动触发
    ; m& c5 n3 q0 {- g
  163. // TIM_ITConfig(TIM1, TIM_IT_CC2|TIM_IT_Update, ENABLE);          //中断配置$ H7 j% E3 c$ y
  164.   TIM_ITConfig(TIM1, TIM_IT_CC2, ENABLE); //通道2 捕获中断打开* w; B' e# |/ a% {! O9 ~
  165.   //TIM_ClearITPendingBit(TIM1, TIM_IT_CC2|TIM_IT_Update); //清除中断标志位
    7 ?' w! G# x3 m( ]8 M! G& B
  166.   TIM_Cmd(TIM1, ENABLE);1 ?3 m! G) h4 w
  167. }: K( m$ H, ^, m
  168. & Y# ?2 |. f! I* Q4 n/ p
  169. & B8 h! Z9 @( M+ I) z
  170. void TIM1_CC_IRQHandler(void), d9 q2 o4 l4 s" x' a9 d
  171. {
    0 {* A8 Q1 X" s) ~2 e5 {

  172. , z0 v2 a9 \: ?; C7 h5 q
  173.         {
      b7 V. J: o2 `$ T: X7 @
  174.                 if (TIM_GetITStatus(TIM1, TIM_IT_CC2) != RESET)//捕获1发生捕获事件( L4 f0 m0 \9 ?+ }/ O
  175.                         {
    0 w& a( K2 N  F# D( p% f  u
  176.                                 duty_TIM1    =   TIM_GetCapture1(TIM1);          //采集占空比$ C& N) V% u, q" S8 D+ v
  177.                            if  (TIM_GetCapture2(TIM1)>600)         period_TIM1        =        TIM_GetCapture2(TIM1);
    : ]5 M* _- {) I9 w9 ~
  178.                                 CollectFlag_TIM1 = 0;
    ' x' T# U( s$ M/ D9 X7 c9 L
  179.                         }
    , q+ h! k% s' L9 `: M' {' V3 Q# X
  180.         }
    5 z& W8 c9 P6 A, z# v% [0 @
  181.                 TIM_ClearITPendingBit(TIM1, TIM_IT_CC2|TIM_IT_Update); //清除中断标志位1 S. s2 ^$ H- {
  182. }
    & Y% c8 m$ g( Q) [7 g

  183. 2 Q5 [. a0 L! W, \& J

  184. ( s% ~6 F  M0 P; K$ v; k6 p
  185. /*功能名称TIM2_PWMINPUT_INIT(u16 arr,u16 psc)
    + g$ S, e2 E; n; Y0 G, a. _) Q- S
  186.   描述      PWM输入初始化*/4 T4 ~5 k/ j" R/ L% `: o+ X/ D. D& j3 x

  187. 8 x8 \8 ?5 k' {% ]) k0 _! y
  188. void TIM2_PWMINPUT_INIT(u16 arr,u16 psc)# |* C) L! Y# O- Y) g. d  ]: R5 x
  189. {
    - h9 l3 g3 H7 a' g

  190. & @- ^: n7 [$ [; a0 Y" v6 F
  191.         TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;        //TIM的初始化结构体% Q# q' ^; U8 m6 J: u
  192.         NVIC_InitTypeDef NVIC_InitStructure;                        //中断配置
    - C4 q. D) y5 `6 r
  193.         TIM_ICInitTypeDef  TIM2_ICInitStructure;                 //TIM2  PWM配置结构体
    $ K, L& M, Q% \8 `* _' j& \
  194.         GPIO_InitTypeDef GPIO_InitStructure;                         //IO口配置结构体* @4 h: `! V( h( W! s; A! d
  195. 3 j& |0 X$ _5 L. y6 m1 K" F
  196.         RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE);     //Open TIM2 clock
    9 O6 k* w0 N2 A, i% R9 q4 `) T
  197. // RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB, ENABLE);  //open gpioB clock, ^; U4 J+ p- ]
  198. RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB  | RCC_APB2Periph_AFIO, ENABLE);  //使能GPIO外设和AFIO复用功能模块时钟
    9 A! O& x1 m! k, ~1 W! t! _0 x0 k
  199. GPIO_PinRemapConfig(GPIO_Remap_SWJ_JTAGDisable,ENABLE);          //关闭JTAG
    # W# S' F9 a; F% w
  200.          GPIO_PinRemapConfig(GPIO_FullRemap_TIM2, ENABLE); //Timer2完全重映射  TIM2_CH2->PB3% ]4 }+ Z# g& s. u6 E# M; M, o3 N
  201. 1 ?* x3 n$ D6 m: d) K
  202.         GPIO_InitStructure.GPIO_Pin = GPIO_Pin_3;             //GPIO 3) H  W; x7 s& S. g: q: |4 a" x" p% M
  203.         GPIO_InitStructure.GPIO_Mode =  GPIO_Mode_IPU;          //浮空输入 上拉输入
    8 R! V& {' N" _% v6 J- L" I8 ~) ?$ a
  204.         GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;+ \; Q. u. O' l6 o5 b1 ?( s4 W
  205.         GPIO_Init(GPIOB, &GPIO_InitStructure);
    6 {" B* ]8 i6 [

  206. & R7 {: Z6 Z1 @$ b- x
  207.         TIM_TimeBaseStructure.TIM_Period = arr; //设置在下一个更新事件装入活动的自动重装载寄存器周期的值
    9 w2 F" V) ^, S' v" Y5 K5 o5 v
  208.         TIM_TimeBaseStructure.TIM_Prescaler =psc; //设置用来作为TIMx时钟频率除数的预分频值0 I+ B/ P" E/ J# Z, D
  209.         TIM_TimeBaseStructure.TIM_ClockDivision = 0; //设置时钟分割:TDTS = Tck_tim
    7 U+ m( D* h; C5 Z* T
  210.         TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;  //TIM向上计数模式
    , l  }3 E; D4 e% h1 I
  211.         TIM_TimeBaseInit(TIM2, &TIM_TimeBaseStructure); //根据TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位
    6 R' V) ]' m  d6 q' }* J

  212. 9 v. j3 K  G; A/ Z) T* V

  213. 6 y# m  n: d9 w6 J" f
  214.         /*配置中断优先级*/
    ' G/ w7 d7 L/ ]
  215.         NVIC_InitStructure.NVIC_IRQChannel = TIM2_IRQn;4 m" q# E, X+ O
  216.   NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 1;
    - \# F9 K/ ?7 `4 \" `
  217.   NVIC_InitStructure.NVIC_IRQChannelSubPriority = 1;
    / ^& P, f8 n% A' R' T
  218.   NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
    ) J' ]6 n/ O2 P  g; V1 c
  219.   NVIC_Init(&NVIC_InitStructure);
    / Q# p; C, `1 ^8 u% y8 j* c
  220. * R9 v: x4 s5 @  k% f+ k9 }7 M
  221.   TIM2_ICInitStructure.TIM_Channel = TIM_Channel_2;5 F7 I/ T7 C5 E- V% M8 s) o9 p
  222.   TIM2_ICInitStructure.TIM_ICPolarity = TIM_ICPolarity_Rising;6 l' {, o# U, z/ O
  223.   TIM2_ICInitStructure.TIM_ICSelection = TIM_ICSelection_DirectTI;! Z$ r7 a. ~; t- S" w6 Y8 i
  224.   TIM2_ICInitStructure.TIM_ICPrescaler = TIM_ICPSC_DIV1;
    # ^- B- s7 J" z
  225.   TIM2_ICInitStructure.TIM_ICFilter = 0x3;   //Filter:过滤+ P+ Z8 {- c) T( o+ N- O/ M" p: K

  226. , l5 ~; r" f8 x. J5 S, u6 Q$ Q4 ^
  227.   TIM_PWMIConfig(TIM2, &TIM2_ICInitStructure);     //PWM输入配置
    9 f: G' ]( x& h* t
  228.   TIM_SelectInputTrigger(TIM2, TIM_TS_TI2FP2);     //选择有效输入端& ?7 l1 m3 d. Z9 X9 B/ v' K7 @
  229.   TIM_SelectSlaveMode(TIM2, TIM_SlaveMode_Reset);  //配置为主从复位模式( f; `$ x6 Y# s0 t- q, S0 q
  230.   TIM_SelectMasterSlaveMode(TIM2, TIM_MasterSlaveMode_Enable);//启动定时器的被动触发
    : B  S6 C1 o# c1 ^4 C! b) ^8 v9 r
  231.   TIM_ITConfig(TIM2, TIM_IT_CC2|TIM_IT_Update, ENABLE);          //中断配置
    & l: K* \# y9 I+ e- [& s0 R
  232.   TIM_ClearITPendingBit(TIM2, TIM_IT_CC2|TIM_IT_Update); //清除中断标志位
    $ N/ n% x1 y8 Z0 b; b
  233.   TIM_Cmd(TIM2, ENABLE);
    ' k8 c+ S" K2 @5 |
  234. }
    + L- s) }. T1 G7 e9 [4 d
  235. ! h) n5 Q  ~8 r7 _, u7 D. v. |
  236. 8 T+ a) t" H6 [* N& O' \& d
  237. void TIM2_IRQHandler(void)
    3 }2 K5 w  b( s
  238. {( F$ u- Y6 o' h4 B
  239.         {
    - f0 `5 B" D: H% D0 s1 P4 u
  240.                 if (TIM_GetITStatus(TIM2, TIM_IT_CC2) != RESET)//捕获1发生捕获事件/ c% l- h3 r6 o# i  H4 |5 R0 C1 J2 S) ?
  241.                         {
    0 C! P) H4 P  [  T4 x5 o
  242.                                 duty_TIM2    =   TIM_GetCapture1(TIM2);          //采集占空比1 e, _9 X. D  L+ n& H
  243.                            if  (TIM_GetCapture2(TIM2)>600)         period_TIM2        =        TIM_GetCapture2(TIM2);
    2 b5 l1 C5 F* C' w, B9 Q! w
  244.                                 CollectFlag_TIM2 = 0;
      g. x6 B: z- l3 Z! a
  245.                         }
    + l) `2 E8 j# m9 D( r; I
  246.         }
    1 V2 d9 k% x3 J& }: J
  247.                 TIM_ClearITPendingBit(TIM2, TIM_IT_CC2|TIM_IT_Update); //清除中断标志位
    . q2 M4 a" W3 m, |( [% O! Z
  248. }& ~) q" P& d. S% L# C

  249. $ D+ Y6 l. L; N5 t1 \0 Q9 y' c' A
  250. /*功能名称TIM5_PWMINPUT_INIT(u16 arr,u16 psc)
    7 X0 T; M* C; ^2 t$ A1 S
  251.   描述      PWM输入初始化*/* X( ^) p3 ^/ i( L6 {0 d7 C) q: z" y$ J
  252. ! b8 Z) C% x! x0 L$ J) {9 o0 ?
  253. void TIM5_PWMINPUT_INIT(u16 arr,u16 psc)
    ' h& p' H8 x  o5 E" Y1 c
  254. {. h( h9 g6 g! y" ^+ }7 `" \
  255. , ^$ h: y  T1 O1 q/ |9 m! g
  256.         TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;        //TIM的初始化结构体9 B0 |% X) H6 P; K) M0 D$ d
  257.         NVIC_InitTypeDef NVIC_InitStructure;                        //中断配置4 x8 d4 A% b9 j: f- \, L5 P) G, D
  258.         TIM_ICInitTypeDef  TIM5_ICInitStructure;                 //TIM4  PWM配置结构体
    ' `& l, V& d: i. [; p  s
  259.         GPIO_InitTypeDef GPIO_InitStructure;                         //IO口配置结构体- n9 m; R) W  d- h' ~; S

  260. " G. e+ T/ S# G5 T4 j( G
  261.         RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM5, ENABLE);     //Open TIM4 clock! _/ F1 F& I( }7 [0 H
  262.   RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE);  //open gpioB clock+ r% k- g  g0 |, Q& x; }
  263. 0 h% ~' j* [8 g) G) v6 A! p3 \& R
  264.         GPIO_InitStructure.GPIO_Pin = GPIO_Pin_1;             //GPIO 15 k0 }7 G! [9 ?+ A* \
  265.   GPIO_InitStructure.GPIO_Mode =  GPIO_Mode_IPU;          //浮空输入 上拉输入
    5 q; U& a7 D6 W/ b# j/ u4 O: r3 S
  266.   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
    % o* q" G. Y* h+ ^; y4 ]1 s9 Q+ k
  267.   GPIO_Init(GPIOA, &GPIO_InitStructure);# t. S- m8 m4 t+ H
  268. ! {. o) C* p: x( q! s  w; c' u
  269.         TIM_TimeBaseStructure.TIM_Period = arr; //设置在下一个更新事件装入活动的自动重装载寄存器周期的值
    6 `* F: S' j6 F; g# ~
  270.         TIM_TimeBaseStructure.TIM_Prescaler =psc; //设置用来作为TIMx时钟频率除数的预分频值
    4 T! W4 N% |1 Y. N) [8 z4 `# X
  271.         TIM_TimeBaseStructure.TIM_ClockDivision = 0; //设置时钟分割:TDTS = Tck_tim5 P: x' {# E' F! `' c
  272.         TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;  //TIM向上计数模式
    ' n6 u- C9 Z' ?0 Z+ h
  273.         TIM_TimeBaseInit(TIM5, &TIM_TimeBaseStructure); //根据TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位
    . a# |3 `* U+ l! m- d/ o1 R

  274. 1 t' F& a& m9 y4 L+ Y1 v+ }
  275.   V6 _% x% N( o* Q+ ]
  276.         /*配置中断优先级*/
    + k6 [0 X3 k8 ~% d) g" e. Z9 @$ j
  277.         NVIC_InitStructure.NVIC_IRQChannel = TIM5_IRQn;
    1 x" p5 l4 p3 ^  h; F& j! w
  278.   NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 1;
    , g) k& X2 f8 ^! ?
  279.   NVIC_InitStructure.NVIC_IRQChannelSubPriority = 1;
    ! `. ~( H8 d8 ^: _3 m
  280.   NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
    ; h  J- O, m6 \
  281.   NVIC_Init(&NVIC_InitStructure);
    " d" [0 D: z( l7 e6 H

  282. 2 }* J- K4 [, [% t( {# ^
  283.   TIM5_ICInitStructure.TIM_Channel = TIM_Channel_2;
    6 K: Q2 i) ]0 ~  {
  284.   TIM5_ICInitStructure.TIM_ICPolarity = TIM_ICPolarity_Rising;( N# H: D$ C: J; t& i4 x" }9 D
  285.   TIM5_ICInitStructure.TIM_ICSelection = TIM_ICSelection_DirectTI;
    ! w, Y4 b1 `8 N" g5 _- A0 \
  286.   TIM5_ICInitStructure.TIM_ICPrescaler = TIM_ICPSC_DIV1;
    2 f0 B1 ^1 j* u, {* ^' W, Y" R
  287.   TIM5_ICInitStructure.TIM_ICFilter = 0x3;   //Filter:过滤$ Z6 ?/ V7 ~/ K; t  @9 M

  288. 5 s- z3 k1 m; O* W$ @1 i7 ?( R
  289.   TIM_PWMIConfig(TIM5, &TIM5_ICInitStructure);     //PWM输入配置
    7 u& u6 q& C# h" K
  290.   TIM_SelectInputTrigger(TIM5, TIM_TS_TI2FP2);     //选择有效输入端
    ! D7 l) w" T; a% Z1 Q
  291.   TIM_SelectSlaveMode(TIM5, TIM_SlaveMode_Reset);  //配置为主从复位模式; J+ K& M7 G$ p& {, {, `2 l
  292.   TIM_SelectMasterSlaveMode(TIM5, TIM_MasterSlaveMode_Enable);//启动定时器的被动触发) D4 ]& Q+ s' O
  293.   TIM_ITConfig(TIM5, TIM_IT_CC2|TIM_IT_Update, ENABLE);          //中断配置% J1 w- n7 d- Q: x( ]
  294.   TIM_ClearITPendingBit(TIM5, TIM_IT_CC2|TIM_IT_Update); //清除中断标志位
    , l4 G& n0 z5 Q! R1 \4 H
  295.   TIM_Cmd(TIM5, ENABLE);
    3 p4 D0 |; t" \6 O% {
  296. }. b* N- B' Y' j# G# X- k

  297.   V- g( m. s: A# D

  298. 6 S% X0 C5 I- D8 H* J
  299. void TIM5_IRQHandler(void)9 |# Q- V+ o0 ^1 t2 v* C1 P
  300. {+ ]9 l( D, y/ c( ^; G
  301.         {* g9 }) n& \# K+ I+ U* v/ l
  302.                 if (TIM_GetITStatus(TIM5, TIM_IT_CC2) != RESET)//捕获1发生捕获事件
    . j) {3 M) _, D% x
  303.                         {0 p* V( x& [0 _* _- K$ U
  304.                                 duty_TIM5    =   TIM_GetCapture1(TIM5);          //采集占空比
    6 z6 B# A# q; Q, _+ [4 b
  305.                         if  (TIM_GetCapture2(TIM5)>600)         period_TIM5        =        TIM_GetCapture2(TIM5);7 ?6 v/ e% a- i; w6 J' {5 @3 D% Y. W
  306.                                 CollectFlag_TIM5 = 0;
    0 I+ _% _. d6 a/ ~. b* r
  307.                         }
    9 t3 Z( e$ }- O% I) L' K8 h# m
  308.         }4 u" M3 U4 N2 @6 m' X8 J
  309.                 TIM_ClearITPendingBit(TIM5, TIM_IT_CC2|TIM_IT_Update); //清除中断标志位4 _# `1 O, g+ J7 W$ m: m
  310. }
复制代码
6 G2 \& ]$ s" p4 ?( I

6 b0 K. F$ R4 g$ R/ ~- ~PID部分:
/ M8 k. K. |+ D. K. O准备部分:先定义PID结构体:
: s7 O' G, G* S/ ?

  1. * G3 v1 b9 I; S' Y
  2.     typedef struct
    3 X% K# j+ N# p% J
  3.     {
    0 z4 M3 T. i* R  ^) K
  4.     int setpoint;//设定目标
    ' d0 t3 H; i* `! v7 c
  5.     int sum_error;//误差累计
    / X$ s& X1 M, d( P' M  K" t
  6.     float proportion ;//比例常数
    ! r, ?8 J* h2 G7 c5 N4 K- _
  7.     float integral ;//积分常数
    1 T  D5 t/ y3 N. {# y
  8.     float derivative;//微分常数( u" u5 r/ P- j7 `, M' J$ C
  9.     int last_error;//e[-1]
    . H+ I# W; x+ F5 P# ]
  10.     int prev_error;//e[-2]0 t/ z; w+ ^( R8 p3 T% h
  11.     }PIDtypedef;
复制代码
7 G$ J9 x( O6 H! c+ P
3 X. A  \5 b3 T: G! h* n4 e

$ E' t1 p2 S. e( M: T1 C这里注意一下成员的数据类型,依据实际需要来定的。
" c3 L& w. x" P& Z在文件中定义几个关键变量:
. @- G- b* U7 l$ {0 @' J
  1. float  Kp =     0.32  ; //比例常数$ e$ |- t' {$ [# v* A$ a
  2. float  Ti =                0.09 ; //积分时间常数" r9 _7 U& }3 w
  3. float Td =                0.0028 ;  //微分时间常数
    9 W  e4 p7 l" ?; A, j2 L
  4. #define T                  0.02 //采样周期
    4 u( Q: `! Q, V0 C1 |+ _/ D  S
  5. #define Ki     Kp*(T/Ti)        // Kp Ki Kd 三个主要参数
    0 @( ?1 J5 L; X* Q# }# W
  6. #define Kd                Kp*(Td/T)
复制代码

0 Q/ y( c* t" L' i+ ~, l+ p1 y$ C# F1 @: {# M
C语言好像用#define 什么什么对程序不太好,各位帮忙写个优化办法看看呢? 用const?
6 u% {/ E, Y% J" G
, ?: o+ f) ?2 f# PPID.H里面主要的几个函数:
! J" c5 A/ Y* V- n
  1. void PIDperiodinit(u16 arr,u16 psc);        //PID 采样定时器设定
    % r0 E+ b4 ?3 ?0 Q# G1 A
  2. void incPIDinit(void);                //初始化,参数清零清零3 U4 |  [" s; C3 Q1 |3 x  g! }2 v
  3. int incPIDcalc(PIDtypedef*PIDx,u16 nextpoint);           //PID计算" v) S# }1 i* N) l
  4. void PID_setpoint(PIDtypedef*PIDx,u16 setvalue);  //设定 PID预期值
    7 x" u8 f" ]( Z( i' c
  5. void PID_set(float pp,float ii,float dd);//设定PID  kp ki kd三个参数9 \& _9 u. J1 L2 Y) T! P
  6. void set_speed(float W1,float W2,float W3,float W4);//设定四个电机的目标转速
复制代码
0 r, g- j% s) o2 ]7 g& _, i

) e, `  H) X$ ?0 I1 o+ IPID处理过程:0 y$ R/ G0 S$ E+ n
岔开一下:这里我控制的是电机的转速w,实际上电机的反馈波形的频率f、电机转速w、控制信号PWM的占空比a三者是大致线性的正比的关系,这里强调这个的目的是9 b& s) y3 Q2 Q* _) X5 L3 O: @2 K
因为楼主在前期一直搞不懂我控制的转速怎么和TIM4输出的PWM的占空比联系起来,后来想清楚里面的联系之后通过公式把各个系数算出来了。
" }1 k5 I- X+ a  y

& j% N2 b' I, ]% l0 L( A# B) n9 ~% _, w正题:控制流程是这样的,首先我设定我需要的车速(对应四个轮子的转速),然后PID就是开始响应了,它先采样电机转速,得到偏差值E,带入PID计算公式,得到调整量也就是最终更改了PWM的占空比,不断调节,直到转速在稳态的一个小范围上下浮动。
8 Z3 n- q9 C) p8 ?5 _上面讲到的“得到调整量”就是增量PID的公式:
* X# ]4 `  _6 g* |
  1.     int incPIDcalc(PIDtypedef *PIDx,u16 nextpoint)
    - ~! ]5 e/ r6 h0 Y
  2.     {
    - d& N$ [1 [8 I# h" ]) |5 ?
  3.     int iError,iincpid;; _% h2 b8 z/ b, v9 f
  4.     iError=PIDx->setpoint-nextpoint;  //当前误差
    4 h; x5 Z4 u4 F9 J
  5.     /*iincpid=                                               //增量计算- i1 D5 u6 E$ q( X( w/ T# r
  6.     PIDx->proportion*iError                //e[k]项
    3 H( B: P# B! s9 j3 X+ q; ?% F3 o/ r
  7.     -PIDx->integral*PIDx->last_error          //e[k-1]$ L- p4 _* m/ t. n  ?, G
  8.     +PIDx->derivative*PIDx->prev_error;//e[k-2]1 y& R* g- m) p/ v" v6 f
  9.     */
    7 q. K5 ]7 e" Q6 N4 j2 F
  10.     iincpid=                                                          //增量计算
    # t3 j8 [$ i& i$ }% [( C
  11.     PIDx->proportion*(iError-PIDx->last_error)  z! [" h# W. ]6 \5 D
  12.     +PIDx->integral*iError
    4 o; y1 m  C. Y3 W% q5 S
  13.     +PIDx->derivative*(iError-2*PIDx->last_error+PIDx->prev_error);
    3 ^4 k- M. R# F; F& t- e* O
  14. 1 u  g5 e! B  }  ^  C2 z: s2 u( {
  15.     PIDx->prev_error=PIDx->last_error; //存储误差,便于下次计算& i( r+ D7 y) J1 x4 M, K6 c
  16.     PIDx->last_error=iError;( I+ U' C3 ], |) x
  17.     return(iincpid) ;6 i- b: p5 n% q
  18.     }
    ! o3 A" e& Y9 D* E' \

  19. % L6 B" N5 c9 d5 c

  20. 0 k( p+ a! p. H8 V0 U0 u
  21. 复制代码
    % h$ l1 c( c5 v/ B) e4 Z* p0 Y
  22.   W+ b7 B0 A; ?( y5 N
  23. 注释掉的是第一种写法,没注释的是第二种以Kp KI kd为系数的写法,实际结果是一样的。
    $ \- N2 [6 G. S1 A+ j$ Y9 V
  24. 处理过程放在了TIM6,溢出周期时间就是是PID里面采样周期(区分于反馈信号的采样,反馈信号采样是1M的频率)
    ; g* z2 b. g& D9 k7 g6 X
  25. 相关代码:
    ! j2 j: c3 m, T

  26. 0 @; I9 P) F' R; K  M, r

  27. , T( o, o6 t& p2 Y. E7 N8 [" ?
  28.     void TIM6_IRQHandler(void)        //        采样时间到,中断处理函数
    8 ~& }/ T1 F9 O# ]+ R% D$ T
  29.     {
    1 k8 [% S; R( W, `7 H, j

  30. 7 L+ V! l+ N5 _2 k9 i0 M  X
  31.     if (TIM_GetITStatus(TIM6, TIM_IT_Update) != RESET)//更新中断
    1 o+ [/ r8 l" F1 X/ V
  32.             {
    : c0 d% ^2 e7 l4 z& B. v
  33.             frequency1=1000000/period_TIM4        ; //通过捕获的波形的周期算出频率. [- r! l" i9 X0 }% A% l
  34.             frequency2=1000000/period_TIM1        ;6 x* w/ b$ N2 s
  35.             frequency3=1000000/period_TIM2        ;
    ! i9 i- b  J" C' P/ q# i& V
  36.             frequency4=1000000/period_TIM5        ;
    9 X) g  s* |8 H* z1 q. @' Z5 M" U
  37.     /********PID1处理**********/7 G+ n9 y  E5 N5 R
  38.             PID1.sum_error+=(incPIDcalc(&PID1,frequency1));         //计算增量并累加  J& y+ h: l! Q3 Z2 o
  39.            pwm1=PID1.sum_error*4.6875  ;   //pwm1 代表将要输出PWM的占空比
    6 J4 A, ~. L5 W2 E! u4 l
  40.               frequency1=0; //清零
    ) Y. ?( c$ p$ y' q
  41.          period_TIM4=0;) A+ C7 L$ X' H, ~! n
  42.     /********PID2处理**********/
    ) o) i6 [6 e3 ~6 h& q7 s5 b
  43.              PID2.sum_error+=(incPIDcalc(&PID2,frequency2));         //计算增量并累加  Y=Y+Y'
    $ `1 g& }5 ?) X& r9 q
  44.              pwm2=PID2.sum_error*4.6875 ;   //将要输出PWM的占空比" T* [; \, Y$ ?; o
  45.             frequency2=0;+ t" @0 _) F" f% o) i$ J4 p+ [3 r
  46.             period_TIM1=0;' x# B# F8 N) y% v$ b! n( \
  47.     /********PID3处理**********/
    " o2 @7 S% ^" s2 l7 Z# \
  48.              PID3.sum_error+=(incPIDcalc(&PID3,frequency3));          //常规PID控制4 K) y) X, X$ y' |
  49.             pwm3=PID3.sum_error*4.6875 ;   //将要输出PWM的占空比
    ; {  W2 [- m  m+ _3 J* {
  50.             frequency3=0;
    ) C) v& |# y: B  h9 h
  51.             period_TIM2=0;
    # f- w$ k  @& p, Y/ Q1 }5 D* f
  52.     /********PID4处理**********/
    # Q/ h9 m% [  t. G6 e$ j- p
  53.                 PID4.sum_error+=(incPIDcalc(&PID4,frequency4));         //计算增量并累加9 `0 l5 b0 C! D$ {% `$ _4 t
  54.              pwm4=PID4.sum_error*4.6875 ;   //将要输出PWM的占空比$ n3 o" V# N6 c4 _& n1 i: Z. s1 w
  55.             frequency4=0;6 G# B. c; t' P7 l* l
  56.             period_TIM5=0;
    . Z1 j, S! o6 r9 _0 u! `. [- U  S; O
  57.               }4 h0 h+ q  \# T) _1 l1 i  U
  58.     TIM_SetCompare(pwm1,pwm2,pwm3,pwm4);             //重新设定PWM值
    : C6 {: R. o6 L' j3 @
  59.     TIM_ClearITPendingBit(TIM6, TIM_IT_Update); //清除中断标志位% b9 y8 W" s2 A" @
  60.     }
复制代码
- ~8 D  q+ n: y( M$ K8 c. y
: C" [& b2 p+ Y3 F% p' t4 D
上面几个代码是PID实现的关键部分6 `1 B0 i% p- ^8 D5 @/ l4 P

7 Q( E* g0 C9 i) X# V整定过程:& D7 y& a: E: h% ?9 L
办法有不少,这里用的是先KP,再TI,再TD,在微调。其他的办法特别是有个尼古拉斯法我发现不适合我这个控制对象。, x) s) j0 a# i
先Kp,就是消除积分和微分部分的影响,这里我纠结过到底是让Ti 等于一个很大的值让Ki=Kp*(T/Ti)里面的KI接近零,还是直接定义KI=0,TI=0.8 Z% p* m5 K) r3 v# K0 i% R3 ^
然后发现前者没法找到KP使系统震荡的临界值,第二个办法可以得到预期的效果:即KP大了会产生震荡,小了会让系统稳定下来,当然这个时候是有稳态误差的。
/ g8 E- J! j1 ]  l) Q; c9 _- W  S" N4 e随后把积分部分加进去,KI=Kp*(T/Ti)这个公式用起来,并且不断调节TI 。TI太大系统稳定时间比较长。
, \% {2 i) t/ K然后加上Kd        =Kp*(Td/T),对于系统响应比较滞后的情况效果好像好一些,我这里的电机反映挺快的,所以Td值很小。& Q2 l: ]+ R7 R! Q; R/ q
最后就是几个参数调节一下,让波形好看一点。这里的波形实际反映的是采集回来的转速值,用STM32的DAC功能输出和转速对应的电压,用示波器采集的。
/ N& ]' a1 j: w3 r% Z+ x最后的波形是这样的:
4 Y7 k$ d' i! Z3 z* P 3.jpg ( {) P. E. `/ S2 D: m' h( E$ r( q. j
最后欢迎大家拍砖,有批评才会让我更加进步!
( D3 c9 x8 g/ |0 W" f最后把PID文件放上来 pid.zip (2.88 KB, 下载次数: 134)
赞 收藏 5 评论17 发布时间:2017-12-26 15:40

举报

17个回答
zero99 回答时间:2017-12-26 16:11:12
大佬,这样插代码效果更加哦$ Y. W8 Q- @! O4 E

5 E9 y& |4 t/ p' I% Q, v
  1. 测试代码- e+ r% ?, z. C$ b7 w3 k3 ~( d3 H
  2. 测试代码
    ; g( p6 h0 [. o
  3. 测试代码4 v7 u  F9 f( F0 t9 Y. V1 r
  4. 测试代码
复制代码

7 Q/ p/ R/ L' r4 i8 b1 ~* {
; p7 x& h  F& U4 q6 J9 n 333333.png
, c  B" H' r8 D6 W  i
二子 回答时间:2018-10-3 11:10:48
nyszx 发表于 2017-12-26 15:41  o) i$ z+ _' b5 M( V  J
再付个网上的资料
' m: E9 C# V3 m( F5 P
这是个好东西' O5 I3 Q) U" q+ s4 P/ r! v0 R5 v6 q
书到用时方恨少
8 q$ o5 E9 B" b7 V5 {6 t+ \& _果断收藏
tlj1b455c 回答时间:2020-8-16 12:15:37
我想问一下,那个编码器得到的脉冲数和占空比有啥关系呀
nyszx 回答时间:2017-12-26 15:41:49
再付个网上的资料 PID控制经典培训教程.pdf (406.07 KB, 下载次数: 183)
nyszx 回答时间:2017-12-26 19:24:38
我马上改过来
东方惑思 回答时间:2017-12-26 20:48:07
学习了,谢谢!
0 i% V& p  r1 v. p& P
板子粉丝 回答时间:2018-5-12 12:58:31
不错,学习了
西点钟灵毓秀 回答时间:2018-7-22 02:13:36
学习了,正好需要
libin1009 回答时间:2018-7-22 15:44:52
学习一下!
shwp 回答时间:2018-8-20 14:08:14
学习
wjwjwjwj997 回答时间:2018-8-21 08:14:50
学习了,正好需要
coobakl 回答时间:2018-8-21 16:10:40
学习了,正好需要
chao2018 回答时间:2018-9-20 09:48:26
谢谢分享!!
gengkeju 回答时间:2018-10-8 14:32:36
赞,学习一下
zjczm 回答时间:2018-10-9 17:31:58
有空学习。
12下一页
关于
我们是谁
投资者关系
意法半导体可持续发展举措
创新与技术
意法半导体官网
联系我们
联系ST分支机构
寻找销售人员和分销渠道
社区
媒体中心
活动与培训
隐私策略
隐私策略
Cookies管理
行使您的权利
官方最新发布
人形机器人运动控制、感知与智能配电
半导体创新技术与应用方向
EE架构与软件定义汽车
12V/48V 汽车智能配电(SPD)
区域控制单元(ZCU)与分区架构
关注我们
st-img 微信公众号
st-img 手机版