/ U* S! H- }4 z" |$ W7 d+ N- L
5 P+ K. d0 c5 K" j. P

继续做实验，任务3和旋钮控制转速。

首先来看看任务3的要求：

这个可通过代码实现也可以通过上位机实现，已经有坛友做过这样的事情了。通过上位机做就是快速拨弄圆盘，这样系统不能在短时间内反转，造成观测器不能收敛，触发速度反馈错误报警，其实我个人觉得这里也是有过流报警存在的，这就看系统优先响应哪一个报警了。

我这里通过代码来实现task3。

任务3代码：

1. void task_3(void)
   9 b6 M  x& k) X% }% z) A7 k
2. {
   0 W# _/ g; T6 m# O' v$ ]: }
3.     MC_ProgramSpeedRampMotor1(-3000/6,1000); //设置-3000rpm的转速，在一秒之内达到
   & P7 ?2 I8 W" z' h6 s
4.     MC_StartMotor1();       //启动电机
   3 F  T8 Y# x5 U6 {+ L" Y/ Y. R8 J
5.     HAL_Delay(500);         //运行500ms
   2 D6 c0 ?0 n1 P! l( O7 Q
6.     while(RUN != MC_GetSTMStateMotor1()); //等待电机处于运行状态，可有可无
   0 w8 w+ Q" z6 C  E' F
7.     MC_ProgramSpeedRampMotor1(3000/6,1000); //切换到3000rpm转速
   
8.     MC_StartMotor1();       //启动电机
   
9.     while(MC_SPEED_FDBK != STM_GetFaultState(&STM[M1])); //等待错误触发
   7 U+ W: p5 W2 V; W2 [- B
10.     HAL_Delay(1000);    //延时一秒,方便可以在上位机上看见错误是否发生
    * @/ k& L4 n2 |  J, N
11.     MC_AcknowledgeFaultMotor1();    //清除错误
    4 G! E! C: u6 r' n" [7 g3 v) D1 K) f* ~
12.     HAL_Delay(100);     //延时0.1秒
    * S! ^6 \) {7 M" F1 u1 @/ I5 m" |0 F( S
13.     MC_ProgramSpeedRampMotor1(MC_GetLastRampFinalSpeedMotor1(),1000);   //重新设置上一次速度值
    , j0 g# s. ?% R; r+ w' @
14.     MC_StartMotor1();   //启动电机
    
15.     HAL_Delay(5000);    //运行5秒
    ' D8 X2 w: y3 j7 _7 O8 ^, T, Q
16.     MC_StopMotor1();    //停机
    
17.     HAL_GPIO_WritePin(LED11_GPIO_Port,LED11_Pin,GPIO_PIN_RESET); //拉低LED引脚，表示任务结束
    ; G/ M; ?8 n  @' B% e8 d* O+ h2 o
18. }
    

复制代码

主函数代码：

1. /* Infinite loop */
   ' E! E% S, a7 r2 u4 @
2.   /* USER CODE BEGIN WHILE */
   
3.   while (1)
   4 c* J2 w/ R/ f& ?/ [3 Z( |
4.   {
   ' u% n' |% p% p9 S0 z. A
5.       
   3 A/ \( p2 W4 {/ w! ?. X
6.       if(GPIO_PIN_SET == HAL_GPIO_ReadPin(LED11_GPIO_Port,LED11_Pin))
   2 x- R3 L8 U( I9 @# X9 i
7.       {
   
8.           task_3();
   : a% N& w* P* Q. X4 u. t
9.       }
   
10.       else
    
11.       {
    
12.         MC_StopMotor1();
    
13.       }      
    
14.   /* USER CODE END WHILE */
    

复制代码

实验现象：

通过速度变化趋势可以看到任务成功实现了，我对比了PPT的预期结果图，有一些差距。当速度设置为3000rpm时，speed reference并没有跟随代码变为3000。另外，我做了延迟清除错误信息，所以在图中可以看到一截零速状态。

. _/ I6 A! Z& @' @

好了，任务3完成。

---------------------------------------------------------

现在分享一个开放性实验，旋钮控制转速，我把这个任务定为任务4吧，用旋钮来控制电机转速我觉得才是真正的一个电机控制系统。

由于SDK中并没有考虑旋钮ADC的初始化，所以如果要使用旋钮电位器首先要通过cubemx对ADC进行初始化，在我的第二篇帖子中已经讲过关于套件的硬件资源，也知道了旋钮电位器连接的是PB1引脚。

创建全局变量：

1. int32_t Speed_Adc = 0;
   % G* \& a1 x: u
2. int32_t Speed_ref = 0;
   ' u2 z3 u: N4 ^0 v; t8 m/ V9 Z' w. @
3. PWMC_Handle_t * MC_SPEED_REF;
   

复制代码

任务4代码：

1. void task_4(void)
     c5 V/ B; C6 X
2. {
   ' K3 u# A) l7 J2 t$ p8 r0 J# u4 f
3.     Speed_Adc = R3_1_F30X_ExecRegularConv(MC_SPEED_REF,ADC_CHANNEL_12);
   % e- D6 r" w; M8 V- D
4.     Speed_ref = (15500*Speed_Adc)>>16;
   7 {  i% Y$ E( |7 U% U( E
5.     if(Speed_ref > 0)
   
6.     {
     I2 c  v. o. {' ^; l- u& L
7.         MC_ProgramSpeedRampMotor1((Speed_ref+1500)/6,1000);
   4 H; M, H: w9 i2 L
8.         MC_StartMotor1();
   
9.     }
   $ i8 x% d  C" v6 @
10.     else
    . Z7 ~- R3 V4 I! [: S+ S
11.     {
    3 T8 J( ^% A* X' b0 V, g8 ?& a* k
12.         MC_StopMotor1();
    
13.     }
    . [' b  e- X: O7 K8 i
14.     HAL_Delay(100);
    
15. }

复制代码

主函数代码：
5 _3 v4 x: l( _  o2 i. u# n

1. /* Initialize interrupts */
   ( b! i  J7 B( W& ~8 Y8 V* y
2.   MX_NVIC_Init();
   
3.   /* USER CODE BEGIN 2 */
   
4.   MC_SPEED_REF = &PWM_Handle_M1._Super;
   
5.   /* USER CODE END 2 */
   
6. 
   . [0 T/ H5 i* N2 `* b
7.   /* Infinite loop */
   
8.   /* USER CODE BEGIN WHILE */
   
9.   while (1)
   ; t6 F' ^8 p' o7 j
10.   {
    % i2 M- }5 ~/ y6 @/ q% C) q/ L
11. 
    / q+ C. w* j& G3 ?3 K$ B' [. j8 q
12.       if(GPIO_PIN_SET == HAL_GPIO_ReadPin(LED11_GPIO_Port,LED11_Pin))
    
13.       {
    3 k5 ?( @1 H2 n' o
14.           task_4();
    
15.       }
    
16.       else
    
17.       {
    7 d4 b( N% g4 }( w
18.           MC_ProgramSpeedRampMotor1(0,0);
    4 ?' q' I/ y; [3 k- z* K4 l3 J
19.           MC_StopMotor1();
    ' a' ]+ P  f3 l. v! f
20.       }
    
21.   /* USER CODE END WHILE */
    , e0 c, m, s- L3 N6 \
22. 
    
23.   /* USER CODE BEGIN 3 */
    
24. 
    
25.   }
    
26.   /* USER CODE END 3 */
    

复制代码

在这里稍微解释一下代码：

Speed_Adc是存储ADC采样值的变量，Speed_ref变量通过ADC采样值转化为速度设定值，MC_SPEED_REF是一个指针变量，用于获取ADC初始化设置，R3_1_F30X_ExecRegularConv这个函数在r3_1_f30x_pwm_curr_fdbk,c这个文件中，用于处理规则ADC采样。速度换算这里可以没什么说的。速度设定的时候加1500偏移是有原因的，当设定速度过低的时候电机系统根本不能正常启动，这是我尝试设置的时候所能达到的最低启动速度。

实验现象：

从实验结果看来，这份代码默认速度PID能很好的跟踪给定转速。

我发现一个问题，代码里面在电机运行结束之后有些变量好像没有清零，这个问题留到后面在研究吧。

本帖两个任务分享就到这里，欢迎大家留言讨论。

' v3 z4 i- m) ^9 I( D1 d

ysx584085668 发表于 2020-4-14 23:23
太感谢了，我发邮件给你看吧

) J) Q6 [# C/ Y, |, m) D' j$ a看了你发的邮件，新版本的MCSDK生成的代码没有留ADC规则转换的函数接口，可能需要你自己去写了，我把我这边生成的文件发你一份参考吧
r3_1_f30x_pwm_curr_fdbk.zip (16.66 KB, 下载次数: 10)

2020-4-15 09:27 上传

点击文件名下载附件

+ Y3 ]2 W; e& ?

子曰好人 发表于 2018-11-6 09:35
SDK5.1.3生成的代码里面没有regular_conversion_manager.c这个文件，5.2.0新增了。获取ADC值的代码是几乎 ...

1.我之前参考您的函数，如果一直不断在执行转换，会影响电机库的控制时序导致无法开机，后来改为500ms一次，就没有问题。后来检查regular_conversion_manager.c中的内容，发现用户ADC的转换应该是电机库的状态机在调度的，如果连续不断转换或者没有走相应的接口估计会有问题。
: I/ j* ?4 P, R, b  {  r+ J, F2.电机Workbench里面有设置OCP参数，看了原理图应该是通过体验板上面的L6230的内置比较器以及SMT32片内的ADC实现的，但是实际中的程序并没有提供类似的功能。后来查看了代码，OCP保护是通过L6230产生的FO信号进行处理的，不知道我说的是否有偏差，还请指教。

代码规整，有功底，佩服！
大佬也会有纰漏啊

/* Infinite loop */
  /* USER CODE BEGIN WHILE */
  while (1)
  {
) u$ U, H" y" l2 e6 C      
      if(GPIO_PIN_SET == HAL_GPIO_ReadPin(LED11_GPIO_Port,LED11_Pin))
3 x/ a* i) V" q/ W8 s      {
          task_5(); ------>task_3();
' _$ R3 f5 u9 `% }) K      }
4 q* o* {0 M4 Z* O5 P      else
      {
        MC_StopMotor1();
4 ]" S1 ^$ ^8 b: O# ?      }      
; U' y( ?' k! [9 c& p6 @/ Q; z! h9 D  /* USER CODE END WHILE */

zhdzhd-174422 发表于 2018-9-2 22:27
& l; `" I( t% ~- G2 o$ n代码规整，有功底，佩服！
, t% f8 k) H3 r# d" t% o- E7 i大佬也会有纰漏啊

不好意思，感谢指正

哈哈，和你观点一样，很多故障报警，都是报的speed feedback，我在测试的时候，连堵转都试过，原本以为是电流过大报警，但没想到居然还是speed feedback故障

stm1024 发表于 2018-9-3 10:24
# K9 R& J, ?) w3 J5 h: t哈哈，和你观点一样，很多故障报警，都是报的speed feedback，我在测试的时候，连堵转都试过，原本以为是电 ...

, M  @/ @' H  y0 `$ i  Q去研究一下电机库生成的故障触发机制代码，也许就能明白了，搞清楚是怎么回事之后就能自定义故障报警了

Speed_Adc = R3_1_F30X_ExecRegularConv(MC_SPEED_REF,ADC_CHANNEL_12); 5.2.0 找不到  R3_1_F30X_ExecRegularConv()?

LT-386596 发表于 2018-9-4 18:38
Speed_Adc = R3_1_F30X_ExecRegularConv(MC_SPEED_REF,ADC_CHANNEL_12); 5.2.0 找不到  R3_1_F30X_ExecRegu ...

! [. D8 i, m. H在r3_1_f30x_pwm_curr_fdbk.c这个文件里面，要调用这个函数需要包含头文件r3_1_f30x_pwm_curr_fdbk.h

VR连接的脚感觉像是PB1,从电路图上来看.

zhdzhd-174422 发表于 2018-9-4 23:27
7 B+ P3 i/ q6 q7 h+ o, R2 L, VVR连接的脚感觉像是PB1,从电路图上来看.

# a) W* M7 I' \& j手误写错了，已更正

楼主，我不太懂Speed_ref = (15500*Speed_Adc)>>16;这段程序中15500的作用时什么？

大神，不知道你有没有注意到有一个小细节，这个USB必须要插在主控板上整个程序好像才能运行，然后不插USB的时候只按开关启动电机，电机启动不起来，不知道大神出现过这情况吗？

花落莫相离 发表于 2018-10-25 19:58
- M3 L4 `3 }: r9 }楼主，我不太懂Speed_ref = (15500*Speed_Adc)>>16;这段程序中15500的作用时什么？

% Z! Z+ M$ X: Y# G15500是电机能达到的最大转速，Speed_Adc的最大值是4096，ADC采样值和速度参考值的换算方式为:（Spped_ref-0）/（Speed_Adc-0）=15500/4096=15500>>16;

花落莫相离 发表于 2018-10-25 20:59
大神，不知道你有没有注意到有一个小细节，这个USB必须要插在主控板上整个程序好像才能运行，然后不插USB的 ...

, \7 P" l, v% |( u没遇到过，我的一直是正常的呀，没有USB连接也能正常运行

学习了  哈哈

子曰好人 发表于 2018-10-26 09:16
& \& t5 y$ j5 `) S# O1 f' C15500是电机能达到的最大转速，Speed_Adc的最大值是4096，ADC采样值和速度参考值的换算方式为:（Spped_re ...

# j9 a0 E% V4 ]多谢楼主解释了。