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

No.5 电机套件实验任务3&旋钮控制转速  

[复制链接]
子曰好人 发布时间:2018-9-2 19:17
本帖最后由 子曰好人 于 2018-9-5 08:55 编辑 3 x2 Y% Y8 F( J3 V# Y

6 ^! Z  h2 l7 f# C
继续做实验,任务3和旋钮控制转速。
首先来看看任务3的要求:
任务3要求.png
这个可通过代码实现也可以通过上位机实现,已经有坛友做过这样的事情了。通过上位机做就是快速拨弄圆盘,这样系统不能在短时间内反转,造成观测器不能收敛,触发速度反馈错误报警,其实我个人觉得这里也是有过流报警存在的,这就看系统优先响应哪一个报警了。
我这里通过代码来实现task3。
任务3代码:
  1. void task_3(void)  h# ~0 Q4 g# R% h9 g
  2. {
    6 v1 F& z! K( O8 R6 X, h- U
  3.     MC_ProgramSpeedRampMotor1(-3000/6,1000); //设置-3000rpm的转速,在一秒之内达到
    # M5 y! k$ M$ X1 ?2 t2 o+ a- r8 u
  4.     MC_StartMotor1();       //启动电机3 [2 |6 I6 p/ o6 F/ \
  5.     HAL_Delay(500);         //运行500ms$ K8 U4 M# i5 C, V' k
  6.     while(RUN != MC_GetSTMStateMotor1()); //等待电机处于运行状态,可有可无' f& a7 `2 Z( }" E4 c
  7.     MC_ProgramSpeedRampMotor1(3000/6,1000); //切换到3000rpm转速$ G" ^8 l4 G4 |4 o, P
  8.     MC_StartMotor1();       //启动电机
    ! y' o2 P8 _0 |# {  P! ]: v
  9.     while(MC_SPEED_FDBK != STM_GetFaultState(&STM[M1])); //等待错误触发0 Z) a! [. L% S* L
  10.     HAL_Delay(1000);    //延时一秒,方便可以在上位机上看见错误是否发生5 P8 R5 O; [- \" u' [5 ^3 z; B
  11.     MC_AcknowledgeFaultMotor1();    //清除错误* p+ T8 z( n: c
  12.     HAL_Delay(100);     //延时0.1秒
      w4 m4 A% s0 N% D
  13.     MC_ProgramSpeedRampMotor1(MC_GetLastRampFinalSpeedMotor1(),1000);   //重新设置上一次速度值
    1 y& B  a$ v" O  ]* `1 S# e
  14.     MC_StartMotor1();   //启动电机
    ' @+ c9 ?) y" Y' l+ Q( h8 I
  15.     HAL_Delay(5000);    //运行5秒4 `  k" H6 \3 a& g& U6 |
  16.     MC_StopMotor1();    //停机9 V0 r# R9 K2 }! [" c
  17.     HAL_GPIO_WritePin(LED11_GPIO_Port,LED11_Pin,GPIO_PIN_RESET); //拉低LED引脚,表示任务结束: ^6 D: n+ P' f
  18. }
    3 `: C% m& _: Z8 b! y4 |
复制代码
主函数代码:
  1. /* Infinite loop */0 V# g. r/ N' d9 K
  2.   /* USER CODE BEGIN WHILE */
    " h/ z9 d- y$ Q4 l, M
  3.   while (1)
    6 G, I7 D$ n% e7 O1 V
  4.   {
    8 l+ \& r8 F9 G) ^4 ]
  5.       
    2 b" F" }* e$ S' Z4 U+ @
  6.       if(GPIO_PIN_SET == HAL_GPIO_ReadPin(LED11_GPIO_Port,LED11_Pin))
    4 L$ W) ^8 j, g
  7.       {" q1 u. b. O% T+ u/ Y/ S9 w9 N/ \
  8.           task_3();
    : j, z8 d# R5 H
  9.       }
      l* Q: x( W2 t& u7 D# b+ O
  10.       else% b  r/ `# K2 B. y( }
  11.       {
    , d. h$ M7 o* |3 o% [5 _% D! O
  12.         MC_StopMotor1();
    ' }' `3 g. T, {+ e" r) J) o! u* M
  13.       }      % T1 n$ V8 ?  i6 E
  14.   /* USER CODE END WHILE */
    - Z/ K; z- {8 C
复制代码
实验现象:
任务三速度变化截图.png
3 }+ a: I/ ~" W! T) y! a
通过速度变化趋势可以看到任务成功实现了,我对比了PPT的预期结果图,有一些差距。当速度设置为3000rpm时,speed reference并没有跟随代码变为3000。另外,我做了延迟清除错误信息,所以在图中可以看到一截零速状态。

* K# V  C3 A# @2 ~' u0 E/ C
! V. r3 P3 F. _  X' R* }% T0 o
好了,任务3完成。
---------------------------------------------------------
现在分享一个开放性实验,旋钮控制转速,我把这个任务定为任务4吧,用旋钮来控制电机转速我觉得才是真正的一个电机控制系统。
由于SDK中并没有考虑旋钮ADC的初始化,所以如果要使用旋钮电位器首先要通过cubemx对ADC进行初始化,在我的第二篇帖子中已经讲过关于套件的硬件资源,也知道了旋钮电位器连接的是PB1引脚。
用户1.png
创建全局变量:
  1. int32_t Speed_Adc = 0;
    % L2 q# }, ~& \' a
  2. int32_t Speed_ref = 0;, v; J6 d2 _7 c0 j; {9 [: x2 {
  3. PWMC_Handle_t * MC_SPEED_REF;2 A2 a- q& ?6 U9 x3 a0 I; R  S% ]" v
复制代码
任务4代码:
  1. void task_4(void)
    5 i: `* K# o6 R7 J
  2. {# A" l: F% W6 U( Q
  3.     Speed_Adc = R3_1_F30X_ExecRegularConv(MC_SPEED_REF,ADC_CHANNEL_12);
    ' _0 N9 z" c) a/ p: z
  4.     Speed_ref = (15500*Speed_Adc)>>16;
    ! a# |3 a: p' a' R% Q% v5 _
  5.     if(Speed_ref > 0), D9 f8 p% V$ u; s8 r+ t4 |* w
  6.     {9 O4 j$ h) w7 N4 I
  7.         MC_ProgramSpeedRampMotor1((Speed_ref+1500)/6,1000);
    7 @2 Q6 Y- [% x
  8.         MC_StartMotor1();- K9 `4 Y( d( e1 v; Z. S$ c" E
  9.     }
    ; `% r% c; Q) V
  10.     else
    2 T, e- P3 N0 k6 A+ d
  11.     {
    * F% o- Z6 ], x7 y. C
  12.         MC_StopMotor1();+ N+ c' _- D3 d  q6 ^% x- ?
  13.     }
    / N% A# Z8 [# D7 n' D
  14.     HAL_Delay(100);
    $ O6 V! s$ @: {7 a
  15. }
复制代码
主函数代码:
: C' i8 T. f" _9 y# h
  1. /* Initialize interrupts */3 H7 |% z7 A: O
  2.   MX_NVIC_Init();
    5 A* K7 l: }* U
  3.   /* USER CODE BEGIN 2 */
    / z4 I9 ?2 R  _
  4.   MC_SPEED_REF = &PWM_Handle_M1._Super;
    # @# i0 p2 `- ]) z7 W9 e! y
  5.   /* USER CODE END 2 */
    5 j; ^; u, _9 r+ r8 b1 @" p) t# n
  6. 7 D( T5 j/ _& E
  7.   /* Infinite loop */
    " L# y$ @7 ]$ v) u0 j2 y! o3 l
  8.   /* USER CODE BEGIN WHILE */" I7 d2 d3 Z- q
  9.   while (1)  o# e  m5 l6 G1 v  J
  10.   {
    ( W# m8 O6 K+ T9 S2 x" l3 f2 @& @

  11. 7 @; {4 [9 M* v
  12.       if(GPIO_PIN_SET == HAL_GPIO_ReadPin(LED11_GPIO_Port,LED11_Pin))4 P7 X/ W% I* T7 G" x: E
  13.       {; K, J1 B0 ?$ t# ~! L$ {* r( z
  14.           task_4();  l0 {1 h9 t( E; N5 L1 u
  15.       }+ }- d5 a* D7 q8 ]3 T9 b
  16.       else
    5 I3 h: S$ Q7 H2 w; x- Q* W9 t8 P
  17.       {
    6 Z4 i6 [; X9 Z0 ~" F
  18.           MC_ProgramSpeedRampMotor1(0,0);; V( H) X) I* z( ^5 Z, h
  19.           MC_StopMotor1();
    / O3 B7 K1 ~2 i/ G/ j! H
  20.       }
    , B7 ~1 U, _& N5 f" w+ \6 N1 H
  21.   /* USER CODE END WHILE *// g* o/ a% N6 ]) g$ O& [+ r9 ]
  22. , M9 c& k: A1 K' c
  23.   /* USER CODE BEGIN 3 */
    3 G' c* E- X4 i; L/ K
  24. : X! I4 q4 d. a- B
  25.   }
    3 E1 r& _- r  z8 ~6 z. p
  26.   /* USER CODE END 3 */3 l2 v+ V7 K7 A, Y& y
复制代码
在这里稍微解释一下代码:
Speed_Adc是存储ADC采样值的变量,Speed_ref变量通过ADC采样值转化为速度设定值,MC_SPEED_REF是一个指针变量,用于获取ADC初始化设置,R3_1_F30X_ExecRegularConv这个函数在r3_1_f30x_pwm_curr_fdbk,c这个文件中,用于处理规则ADC采样。速度换算这里可以没什么说的。速度设定的时候加1500偏移是有原因的,当设定速度过低的时候电机系统根本不能正常启动,这是我尝试设置的时候所能达到的最低启动速度。

: o& C; H* s1 W
实验现象:
旋钮调速转速跟踪波形.png
从实验结果看来,这份代码默认速度PID能很好的跟踪给定转速。
我发现一个问题,代码里面在电机运行结束之后有些变量好像没有清零,这个问题留到后面在研究吧。

) _2 Q8 C+ k2 W) X
本帖两个任务分享就到这里,欢迎大家留言讨论。( n+ W. b6 U# h" {; y' q
$ R! e5 ^/ ~" [1 E+ D  v. h2 [- z
) @. X; z* P, V3 a1 ?" x" G$ `
4 u7 ?# W* s% ^# J8 b7 q

/ C. w3 y# K8 o7 G# [4 h
赞 1 收藏 2 评论118 发布时间:2018-9-2 19:17

举报

118个回答
子曰好人 回答时间:2020-4-15 09:28:07
ysx584085668 发表于 2020-4-14 23:23
- I; l+ A% v$ b7 R2 x! J" }太感谢了,我发邮件给你看吧
9 x- {! l" V& l+ T$ k
看了你发的邮件,新版本的MCSDK生成的代码没有留ADC规则转换的函数接口,可能需要你自己去写了,我把我这边生成的文件发你一份参考吧
- ^0 w6 U  K: Z r3_1_f30x_pwm_curr_fdbk.zip (16.66 KB, 下载次数: 10)
passby328 回答时间:2018-11-6 11:04:29
子曰好人 发表于 2018-11-6 09:35
0 s7 s8 q- i) U' B; Z* O" e: PSDK5.1.3生成的代码里面没有regular_conversion_manager.c这个文件,5.2.0新增了。获取ADC值的代码是几乎 ...

4 ?- p3 x, J2 x5 W; o' E7 u1.我之前参考您的函数,如果一直不断在执行转换,会影响电机库的控制时序导致无法开机,后来改为500ms一次,就没有问题。后来检查regular_conversion_manager.c中的内容,发现用户ADC的转换应该是电机库的状态机在调度的,如果连续不断转换或者没有走相应的接口估计会有问题。  @/ E( [& M2 Y& ^% @
2.电机Workbench里面有设置OCP参数,看了原理图应该是通过体验板上面的L6230的内置比较器以及SMT32片内的ADC实现的,但是实际中的程序并没有提供类似的功能。后来查看了代码,OCP保护是通过L6230产生的FO信号进行处理的,不知道我说的是否有偏差,还请指教。
zhdzhd 回答时间:2018-9-2 22:27:32
代码规整,有功底,佩服!3 c( }6 U0 d' f$ q
大佬也会有纰漏啊4 s9 U1 o( a3 Y

. G, t8 e) @) @1 }' |/* Infinite loop */
1 |! t0 f6 B5 o6 o% v) \. @' H! J  /* USER CODE BEGIN WHILE */7 E+ B- h3 r1 F$ u' B' q
  while (1)
2 C/ r) Y. q- H) f# I" \/ ?) f; \  {) r: I3 }% q4 H3 Q* I  w
      + K) _# c4 Y: X
      if(GPIO_PIN_SET == HAL_GPIO_ReadPin(LED11_GPIO_Port,LED11_Pin))/ a+ L& C, a7 `  `
      {
5 L  p& k3 P7 M3 o          task_5(); ------>task_3();( H8 ]/ j- ?6 d2 K5 G4 o6 w: _7 M
      }% F+ j: [  v( l
      else/ I- [1 n) b- v4 J8 b& {
      {
7 |: f% p1 v! ~' [) Z! g0 V        MC_StopMotor1();
1 B) s( x- d  r' v9 z% O1 [      }      
- m/ R% J9 S- o9 A+ j) f2 ]; z# h  /* USER CODE END WHILE */
子曰好人 回答时间:2018-9-2 22:36:27
zhdzhd-174422 发表于 2018-9-2 22:27
' J& c3 [9 p0 G1 a. G9 D代码规整,有功底,佩服!1 y; b0 Q, {6 ]. z# f5 [& s$ K
大佬也会有纰漏啊
/ w' c& Q8 c0 |# C% p! I
不好意思,感谢指正
STM1024 回答时间:2018-9-3 10:24:43
哈哈,和你观点一样,很多故障报警,都是报的speed feedback,我在测试的时候,连堵转都试过,原本以为是电流过大报警,但没想到居然还是speed feedback故障
子曰好人 回答时间:2018-9-3 10:45:56
stm1024 发表于 2018-9-3 10:24
) S7 ]* ^/ W$ h2 v( j: Z哈哈,和你观点一样,很多故障报警,都是报的speed feedback,我在测试的时候,连堵转都试过,原本以为是电 ...

$ r8 a$ z/ F; Y1 f$ a) u去研究一下电机库生成的故障触发机制代码,也许就能明白了,搞清楚是怎么回事之后就能自定义故障报警了
LT-386596 回答时间:2018-9-4 18:38:17
Speed_Adc = R3_1_F30X_ExecRegularConv(MC_SPEED_REF,ADC_CHANNEL_12); 5.2.0 找不到  R3_1_F30X_ExecRegularConv()?
  ^3 g' O" G4 P4 j
子曰好人 回答时间:2018-9-4 22:54:20
LT-386596 发表于 2018-9-4 18:387 D9 j: X8 L5 _8 w
Speed_Adc = R3_1_F30X_ExecRegularConv(MC_SPEED_REF,ADC_CHANNEL_12); 5.2.0 找不到  R3_1_F30X_ExecRegu ...

9 o% [  k3 D1 ^7 k, `在r3_1_f30x_pwm_curr_fdbk.c这个文件里面,要调用这个函数需要包含头文件r3_1_f30x_pwm_curr_fdbk.h
zhdzhd 回答时间:2018-9-4 23:27:57
VR连接的脚感觉像是PB1,从电路图上来看.
子曰好人 回答时间:2018-9-5 08:56:32
zhdzhd-174422 发表于 2018-9-4 23:27+ I2 Q: N0 J4 e, j0 a& k# S5 e8 H
VR连接的脚感觉像是PB1,从电路图上来看.

8 [$ l/ _1 o5 t/ E: K4 H手误写错了,已更正
花落莫相离 回答时间:2018-10-25 19:58:06
楼主,我不太懂Speed_ref = (15500*Speed_Adc)>>16;这段程序中15500的作用时什么?
花落莫相离 回答时间:2018-10-25 20:59:33
大神,不知道你有没有注意到有一个小细节,这个USB必须要插在主控板上整个程序好像才能运行,然后不插USB的时候只按开关启动电机,电机启动不起来,不知道大神出现过这情况吗?
子曰好人 回答时间:2018-10-26 09:16:20
花落莫相离 发表于 2018-10-25 19:58
4 d, R7 X3 }3 ?# r% z楼主,我不太懂Speed_ref = (15500*Speed_Adc)>>16;这段程序中15500的作用时什么?

7 `" c% b6 A' q" Z5 I1 v15500是电机能达到的最大转速,Speed_Adc的最大值是4096,ADC采样值和速度参考值的换算方式为:(Spped_ref-0)/(Speed_Adc-0)=15500/4096=15500>>16;
子曰好人 回答时间:2018-10-26 20:20:40
花落莫相离 发表于 2018-10-25 20:59
8 O0 f: Y# e( T大神,不知道你有没有注意到有一个小细节,这个USB必须要插在主控板上整个程序好像才能运行,然后不插USB的 ...
. [" o' K/ m. s- O. n
没遇到过,我的一直是正常的呀,没有USB连接也能正常运行
晴空 回答时间:2018-10-29 15:53:32
学习了  哈哈
花落莫相离 回答时间:2018-10-31 13:51:43
子曰好人 发表于 2018-10-26 09:16$ F. |! n0 F$ j) k2 q
15500是电机能达到的最大转速,Speed_Adc的最大值是4096,ADC采样值和速度参考值的换算方式为:(Spped_re ...

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