本帖最后由 子曰好人 于 2018-9-5 08:55 编辑
1 C8 G6 y1 O( Q" a' M9 Z6 D F* m0 @( {! i. F
继续做实验,任务3和旋钮控制转速。 首先来看看任务3的要求: 这个可通过代码实现也可以通过上位机实现,已经有坛友做过这样的事情了。通过上位机做就是快速拨弄圆盘,这样系统不能在短时间内反转,造成观测器不能收敛,触发速度反馈错误报警,其实我个人觉得这里也是有过流报警存在的,这就看系统优先响应哪一个报警了。 我这里通过代码来实现task3。 任务3代码: - void task_3(void); g+ U! e. G( n5 M
- {
2 ]. r5 F6 E8 O0 v) R - MC_ProgramSpeedRampMotor1(-3000/6,1000); //设置-3000rpm的转速,在一秒之内达到
( `$ }6 ?% z* C) g* Q5 c - MC_StartMotor1(); //启动电机$ f" g& E; K& v& C
- HAL_Delay(500); //运行500ms
5 Q- `+ w) W) l8 R - while(RUN != MC_GetSTMStateMotor1()); //等待电机处于运行状态,可有可无
* J- S# w5 |. p, g- m/ R - MC_ProgramSpeedRampMotor1(3000/6,1000); //切换到3000rpm转速6 V: x! e, ?- p+ D6 w5 v
- MC_StartMotor1(); //启动电机" y+ r& X% g7 C, B* M
- while(MC_SPEED_FDBK != STM_GetFaultState(&STM[M1])); //等待错误触发
. W! W) y5 }" ?0 u/ _. A) ~ - HAL_Delay(1000); //延时一秒,方便可以在上位机上看见错误是否发生
0 \3 [7 c0 a/ u/ S - MC_AcknowledgeFaultMotor1(); //清除错误6 K6 s3 L, n1 b3 E
- HAL_Delay(100); //延时0.1秒
2 g5 Q5 E1 o+ M" \2 E2 s* \4 w" \ - MC_ProgramSpeedRampMotor1(MC_GetLastRampFinalSpeedMotor1(),1000); //重新设置上一次速度值* R% ^8 a y- I8 w8 b1 M3 J
- MC_StartMotor1(); //启动电机6 _+ y# z/ ^) W5 w" A/ e
- HAL_Delay(5000); //运行5秒
9 I: S5 n0 i& }- c( f: e9 Z5 e - MC_StopMotor1(); //停机3 d$ T$ F% a. ^& P/ J
- HAL_GPIO_WritePin(LED11_GPIO_Port,LED11_Pin,GPIO_PIN_RESET); //拉低LED引脚,表示任务结束; V! e& ?6 v9 V6 n4 b. p
- }
. L/ A8 r' V( n! Y
复制代码主函数代码: - /* Infinite loop */
* b5 ?, i4 L1 s. d/ r/ U7 ^ - /* USER CODE BEGIN WHILE */ n# r6 b0 v0 N5 d
- while (1)8 J5 I. T+ U9 q- Z2 E
- {) A( w# e- a- Z$ B% a
- : |4 P, ]+ `% N; B6 M
- if(GPIO_PIN_SET == HAL_GPIO_ReadPin(LED11_GPIO_Port,LED11_Pin)) t0 I! {' X5 ~
- {$ E+ {/ g3 D' ]4 B% c
- task_3();
8 }( i0 c" S+ ` O - }! S$ _3 k0 q1 k" \; Q
- else
: k* d% G/ j9 r - {
8 ?5 L8 z j, e+ g' `8 c2 K6 r - MC_StopMotor1();4 | i9 X5 E7 t% [! C
- } & W Z/ F8 v; K& K% o
- /* USER CODE END WHILE */
" i5 B2 O: i4 o$ ~5 I
复制代码实验现象:
O* x! ?/ P( C, i通过速度变化趋势可以看到任务成功实现了,我对比了PPT的预期结果图,有一些差距。当速度设置为3000rpm时,speed reference并没有跟随代码变为3000。另外,我做了延迟清除错误信息,所以在图中可以看到一截零速状态。
6 X# ]1 H: @& e2 c
! C. p' {% ^2 k* O好了,任务3完成。
--------------------------------------------------------- 现在分享一个开放性实验,旋钮控制转速,我把这个任务定为任务4吧,用旋钮来控制电机转速我觉得才是真正的一个电机控制系统。 由于SDK中并没有考虑旋钮ADC的初始化,所以如果要使用旋钮电位器首先要通过cubemx对ADC进行初始化,在我的第二篇帖子中已经讲过关于套件的硬件资源,也知道了旋钮电位器连接的是PB1引脚。 创建全局变量: - int32_t Speed_Adc = 0;- G# _, }, _3 s' X: U
- int32_t Speed_ref = 0;- u) a$ j1 y) r g9 h$ h
- PWMC_Handle_t * MC_SPEED_REF;: h5 M* [1 i' w
复制代码任务4代码: - void task_4(void); I9 i$ d9 {% G2 ~; L: v
- {* p9 }. d! n" T1 y, u
- Speed_Adc = R3_1_F30X_ExecRegularConv(MC_SPEED_REF,ADC_CHANNEL_12);3 i/ a( K) B, ~* j. }
- Speed_ref = (15500*Speed_Adc)>>16;; n3 l- E7 L" w* P3 q+ ^5 q
- if(Speed_ref > 0)
% c* h8 D+ ?* w7 \ - {
+ {- m9 G$ R* F3 F/ d - MC_ProgramSpeedRampMotor1((Speed_ref+1500)/6,1000);9 ?6 V1 I& N. |! [; L4 M
- MC_StartMotor1();
# i' h' t8 }# B- z - }- H Z! R8 X. g
- else$ m4 i: }5 }1 P
- {; s! L5 y1 S$ I; T6 ^7 E
- MC_StopMotor1();6 O ]3 p% q, W2 c V# \
- }" [& `$ {4 S- N$ c
- HAL_Delay(100);
0 U4 \: m" Q9 p( e2 j3 m; t5 M7 \ - }
复制代码 主函数代码:0 s( g! Z" P: A: {& i4 u! Y
- /* Initialize interrupts */" u5 m. ]- q f( \. B
- MX_NVIC_Init();1 u1 ~( n# S" _+ B1 O
- /* USER CODE BEGIN 2 */
6 c! A' u: B. Z$ c - MC_SPEED_REF = &PWM_Handle_M1._Super;
$ }$ ^& c0 R* R# b/ {2 f: C - /* USER CODE END 2 */. @* {6 j( _; {/ B5 n- b3 j$ O0 n
6 d1 h2 d4 @5 I- /* Infinite loop */
1 l7 B* H$ N6 k0 Y9 v8 A - /* USER CODE BEGIN WHILE */
/ v( q. P7 V- T- M m" x* J - while (1)
1 C: O k& n3 e( A - {
5 O& b9 ^! ?, ]. c0 y3 l - ' f4 q# f6 P }; q8 |
- if(GPIO_PIN_SET == HAL_GPIO_ReadPin(LED11_GPIO_Port,LED11_Pin))
$ t4 G* P1 q7 l5 P - {( ], K/ ^0 x" V' ?
- task_4();
. S/ |0 R8 D; v+ P1 o' i - }$ i" S- V3 I9 Z9 @. E6 S7 t4 n
- else/ `; P. F0 u, u
- {( R: ~1 w+ \$ J3 V* K1 e
- MC_ProgramSpeedRampMotor1(0,0);8 d4 D$ [# Y) A* e7 v9 b9 |
- MC_StopMotor1();' `8 @) S- z8 T7 m
- }
T+ I5 w0 K) F7 @5 v! k; b - /* USER CODE END WHILE */
- W) [' m- x/ _" c2 w( I! a - , N' w. z' q' W& e. G
- /* USER CODE BEGIN 3 */; m0 b' X. H/ p% N
- ; c8 S* O- J( C% x8 b: X+ X
- }
# R* M' Z" G- O# N% u) p+ F - /* USER CODE END 3 */
8 E8 w( ?, E6 o/ f( v. M0 U
复制代码在这里稍微解释一下代码: Speed_Adc是存储ADC采样值的变量,Speed_ref变量通过ADC采样值转化为速度设定值,MC_SPEED_REF是一个指针变量,用于获取ADC初始化设置,R3_1_F30X_ExecRegularConv这个函数在r3_1_f30x_pwm_curr_fdbk,c这个文件中,用于处理规则ADC采样。速度换算这里可以没什么说的。速度设定的时候加1500偏移是有原因的,当设定速度过低的时候电机系统根本不能正常启动,这是我尝试设置的时候所能达到的最低启动速度。
9 B5 N% `! G9 e$ u( U. L实验现象: 从实验结果看来,这份代码默认速度PID能很好的跟踪给定转速。 我发现一个问题,代码里面在电机运行结束之后有些变量好像没有清零,这个问题留到后面在研究吧。 Q0 w6 Y& k0 T3 o8 D6 \* O1 M
本帖两个任务分享就到这里,欢迎大家留言讨论。
3 D1 s$ S% Z3 {0 s 5 `1 W: m4 j% V6 y) J
0 G. }! G# h. m( e
& L* G# _4 l% } V$ h2 ~" k1 B Q
; }5 v$ M8 x* S$ \( ]( E% B: L! c2 w |
看了你发的邮件,新版本的MCSDK生成的代码没有留ADC规则转换的函数接口,可能需要你自己去写了,我把我这边生成的文件发你一份参考吧1 k0 j- N1 I. g$ b
. a! W( {7 T7 Q) [2 _% g
1.我之前参考您的函数,如果一直不断在执行转换,会影响电机库的控制时序导致无法开机,后来改为500ms一次,就没有问题。后来检查regular_conversion_manager.c中的内容,发现用户ADC的转换应该是电机库的状态机在调度的,如果连续不断转换或者没有走相应的接口估计会有问题。, X( M; P+ B8 W @" q! w2 V( \, F
2.电机Workbench里面有设置OCP参数,看了原理图应该是通过体验板上面的L6230的内置比较器以及SMT32片内的ADC实现的,但是实际中的程序并没有提供类似的功能。后来查看了代码,OCP保护是通过L6230产生的FO信号进行处理的,不知道我说的是否有偏差,还请指教。
大佬也会有纰漏啊0 e) N7 p, k2 c6 h. p9 O
$ N& c. S9 o$ }2 Q4 M- B/ F; h
/* Infinite loop */
/* USER CODE BEGIN WHILE *// I5 t- a' L5 D
while (1)+ K0 T8 R+ K+ ?* }- `
{! n1 z7 h& N/ \) w u* H
if(GPIO_PIN_SET == HAL_GPIO_ReadPin(LED11_GPIO_Port,LED11_Pin))/ O$ h/ W2 N5 q$ B j0 ?
{0 V. V7 x0 W B; t
task_5(); ------>task_3();
}, ~3 E- w6 `; V
else1 }- f Q" R7 f; K: [* k! m2 o
{6 W" m0 E; {2 Z" t* j
MC_StopMotor1();
}
/* USER CODE END WHILE */
不好意思,感谢指正
去研究一下电机库生成的故障触发机制代码,也许就能明白了,搞清楚是怎么回事之后就能自定义故障报警了
在r3_1_f30x_pwm_curr_fdbk.c这个文件里面,要调用这个函数需要包含头文件r3_1_f30x_pwm_curr_fdbk.h
手误写错了,已更正
15500是电机能达到的最大转速,Speed_Adc的最大值是4096,ADC采样值和速度参考值的换算方式为:(Spped_ref-0)/(Speed_Adc-0)=15500/4096=15500>>16;
没遇到过,我的一直是正常的呀,没有USB连接也能正常运行
多谢楼主解释了。