本帖最后由 子曰好人 于 2018-9-5 08:55 编辑 3 x2 Y% Y8 F( J3 V# Y
6 ^! Z h2 l7 f# C继续做实验,任务3和旋钮控制转速。 首先来看看任务3的要求: 这个可通过代码实现也可以通过上位机实现,已经有坛友做过这样的事情了。通过上位机做就是快速拨弄圆盘,这样系统不能在短时间内反转,造成观测器不能收敛,触发速度反馈错误报警,其实我个人觉得这里也是有过流报警存在的,这就看系统优先响应哪一个报警了。 我这里通过代码来实现task3。 任务3代码: - void task_3(void) h# ~0 Q4 g# R% h9 g
- {
6 v1 F& z! K( O8 R6 X, h- U - MC_ProgramSpeedRampMotor1(-3000/6,1000); //设置-3000rpm的转速,在一秒之内达到
# M5 y! k$ M$ X1 ?2 t2 o+ a- r8 u - MC_StartMotor1(); //启动电机3 [2 |6 I6 p/ o6 F/ \
- HAL_Delay(500); //运行500ms$ K8 U4 M# i5 C, V' k
- while(RUN != MC_GetSTMStateMotor1()); //等待电机处于运行状态,可有可无' f& a7 `2 Z( }" E4 c
- MC_ProgramSpeedRampMotor1(3000/6,1000); //切换到3000rpm转速$ G" ^8 l4 G4 |4 o, P
- MC_StartMotor1(); //启动电机
! y' o2 P8 _0 |# { P! ]: v - while(MC_SPEED_FDBK != STM_GetFaultState(&STM[M1])); //等待错误触发0 Z) a! [. L% S* L
- HAL_Delay(1000); //延时一秒,方便可以在上位机上看见错误是否发生5 P8 R5 O; [- \" u' [5 ^3 z; B
- MC_AcknowledgeFaultMotor1(); //清除错误* p+ T8 z( n: c
- HAL_Delay(100); //延时0.1秒
w4 m4 A% s0 N% D - MC_ProgramSpeedRampMotor1(MC_GetLastRampFinalSpeedMotor1(),1000); //重新设置上一次速度值
1 y& B a$ v" O ]* `1 S# e - MC_StartMotor1(); //启动电机
' @+ c9 ?) y" Y' l+ Q( h8 I - HAL_Delay(5000); //运行5秒4 ` k" H6 \3 a& g& U6 |
- MC_StopMotor1(); //停机9 V0 r# R9 K2 }! [" c
- HAL_GPIO_WritePin(LED11_GPIO_Port,LED11_Pin,GPIO_PIN_RESET); //拉低LED引脚,表示任务结束: ^6 D: n+ P' f
- }
3 `: C% m& _: Z8 b! y4 |
复制代码主函数代码: - /* Infinite loop */0 V# g. r/ N' d9 K
- /* USER CODE BEGIN WHILE */
" h/ z9 d- y$ Q4 l, M - while (1)
6 G, I7 D$ n% e7 O1 V - {
8 l+ \& r8 F9 G) ^4 ] -
2 b" F" }* e$ S' Z4 U+ @ - if(GPIO_PIN_SET == HAL_GPIO_ReadPin(LED11_GPIO_Port,LED11_Pin))
4 L$ W) ^8 j, g - {" q1 u. b. O% T+ u/ Y/ S9 w9 N/ \
- task_3();
: j, z8 d# R5 H - }
l* Q: x( W2 t& u7 D# b+ O - else% b r/ `# K2 B. y( }
- {
, d. h$ M7 o* |3 o% [5 _% D! O - MC_StopMotor1();
' }' `3 g. T, {+ e" r) J) o! u* M - } % T1 n$ V8 ? i6 E
- /* USER CODE END WHILE */
- Z/ K; z- {8 C
复制代码实验现象:
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引脚。 创建全局变量: - int32_t Speed_Adc = 0;
% L2 q# }, ~& \' a - int32_t Speed_ref = 0;, v; J6 d2 _7 c0 j; {9 [: x2 {
- PWMC_Handle_t * MC_SPEED_REF;2 A2 a- q& ?6 U9 x3 a0 I; R S% ]" v
复制代码任务4代码: - void task_4(void)
5 i: `* K# o6 R7 J - {# A" l: F% W6 U( Q
- Speed_Adc = R3_1_F30X_ExecRegularConv(MC_SPEED_REF,ADC_CHANNEL_12);
' _0 N9 z" c) a/ p: z - Speed_ref = (15500*Speed_Adc)>>16;
! a# |3 a: p' a' R% Q% v5 _ - if(Speed_ref > 0), D9 f8 p% V$ u; s8 r+ t4 |* w
- {9 O4 j$ h) w7 N4 I
- MC_ProgramSpeedRampMotor1((Speed_ref+1500)/6,1000);
7 @2 Q6 Y- [% x - MC_StartMotor1();- K9 `4 Y( d( e1 v; Z. S$ c" E
- }
; `% r% c; Q) V - else
2 T, e- P3 N0 k6 A+ d - {
* F% o- Z6 ], x7 y. C - MC_StopMotor1();+ N+ c' _- D3 d q6 ^% x- ?
- }
/ N% A# Z8 [# D7 n' D - HAL_Delay(100);
$ O6 V! s$ @: {7 a - }
复制代码 主函数代码:
: C' i8 T. f" _9 y# h- /* Initialize interrupts */3 H7 |% z7 A: O
- MX_NVIC_Init();
5 A* K7 l: }* U - /* USER CODE BEGIN 2 */
/ z4 I9 ?2 R _ - MC_SPEED_REF = &PWM_Handle_M1._Super;
# @# i0 p2 `- ]) z7 W9 e! y - /* USER CODE END 2 */
5 j; ^; u, _9 r+ r8 b1 @" p) t# n - 7 D( T5 j/ _& E
- /* Infinite loop */
" L# y$ @7 ]$ v) u0 j2 y! o3 l - /* USER CODE BEGIN WHILE */" I7 d2 d3 Z- q
- while (1) o# e m5 l6 G1 v J
- {
( W# m8 O6 K+ T9 S2 x" l3 f2 @& @
7 @; {4 [9 M* v- if(GPIO_PIN_SET == HAL_GPIO_ReadPin(LED11_GPIO_Port,LED11_Pin))4 P7 X/ W% I* T7 G" x: E
- {; K, J1 B0 ?$ t# ~! L$ {* r( z
- task_4(); l0 {1 h9 t( E; N5 L1 u
- }+ }- d5 a* D7 q8 ]3 T9 b
- else
5 I3 h: S$ Q7 H2 w; x- Q* W9 t8 P - {
6 Z4 i6 [; X9 Z0 ~" F - MC_ProgramSpeedRampMotor1(0,0);; V( H) X) I* z( ^5 Z, h
- MC_StopMotor1();
/ O3 B7 K1 ~2 i/ G/ j! H - }
, B7 ~1 U, _& N5 f" w+ \6 N1 H - /* USER CODE END WHILE *// g* o/ a% N6 ]) g$ O& [+ r9 ]
- , M9 c& k: A1 K' c
- /* USER CODE BEGIN 3 */
3 G' c* E- X4 i; L/ K - : X! I4 q4 d. a- B
- }
3 E1 r& _- r z8 ~6 z. p - /* 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实验现象: 从实验结果看来,这份代码默认速度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 |
看了你发的邮件,新版本的MCSDK生成的代码没有留ADC规则转换的函数接口,可能需要你自己去写了,我把我这边生成的文件发你一份参考吧
1.我之前参考您的函数,如果一直不断在执行转换,会影响电机库的控制时序导致无法开机,后来改为500ms一次,就没有问题。后来检查regular_conversion_manager.c中的内容,发现用户ADC的转换应该是电机库的状态机在调度的,如果连续不断转换或者没有走相应的接口估计会有问题。 @/ E( [& M2 Y& ^% @
2.电机Workbench里面有设置OCP参数,看了原理图应该是通过体验板上面的L6230的内置比较器以及SMT32片内的ADC实现的,但是实际中的程序并没有提供类似的功能。后来查看了代码,OCP保护是通过L6230产生的FO信号进行处理的,不知道我说的是否有偏差,还请指教。
大佬也会有纰漏啊
/* Infinite loop */
/* USER CODE BEGIN WHILE */7 E+ B- h3 r1 F$ u' B' q
while (1)
{) 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 ` `
{
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& {
{
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连接也能正常运行
多谢楼主解释了。