本帖最后由 子曰好人 于 2018-9-3 23:06 编辑
8 a+ \% J r' n# q: E) @! }1 z6 ^1 P% @
转矩模式任务- ~/ u! l* J, a, r" b) D; C
( N. O; @, A5 g电机库给我们提供了转矩控制的接口函数voidMC_ProgramTorqueRampMotor1( int16_t hFinalTorque, uint16_t hDurationms )。函数第一个参数是目标转矩,第二个参数是持续时间,也就是经过多少时间达到目标转矩。 转矩模式我就自定义为任务5了,代码如下: - int16_t Torque_adc = 0;! \3 z3 W# L) d5 u
- int16_t Torque_ref = 0;
0 e* i- i' O) y, s, Z J, a - void task_5(void)
2 P. O5 Z7 V2 \! Z - {' T: x+ a( t2 H' P2 E) T+ Q
- Torque_adc = R3_1_F30X_ExecRegularConv(MC_SPEED_REF,ADC_CHANNEL_12);6 T3 U: r2 }4 v8 R& o; E* \+ e9 N
- Torque_ref = (5000*Torque_adc)>>16;: D- Y( C* b3 \. o5 e( O( ~' H8 B
- if(Torque_ref > 0)
! F. `0 W, l/ Z' t5 g - {3 U/ q( K1 O" q+ G2 j' @& _9 U
- MC_ProgramTorqueRampMotor1(Torque_ref+900, 1000);9 o/ a2 q; |$ ]6 z N. W
- MC_StartMotor1();) R- a8 M* M" v& R: N, W$ t" d
- }
5 @9 S" A# ? S& w2 x5 I3 O - else8 W5 k g5 G! e3 \6 ]4 z
- {4 D, ?+ e( q% [& ]7 \$ ]+ A4 P) e. ?
- MC_StopMotor1();7 R# o% o) _# I4 Q% P" m
- }2 L5 N& Z1 i8 u/ y& f8 o
- HAL_Delay(100);
0 k* k$ W2 L, T- ? - }
' _0 \, p% V, {/ e
复制代码主函数代码: - /* Infinite loop */
" W5 N( o, D8 n! v2 ^3 \1 j* V* E - /* USER CODE BEGIN WHILE */! W9 w) t# @) f7 X9 F9 c( m" z4 U
- while (1)8 O3 V0 g7 j1 X( B L5 [2 [1 F# V
- {3 N; l/ K' {6 ?+ [
- - o; V$ l( T7 a7 B5 D( ]6 j2 k
- if(GPIO_PIN_SET == HAL_GPIO_ReadPin(LED11_GPIO_Port,LED11_Pin))
6 i1 U5 V- K) r - {
7 h" N9 M: ]- K) p) O/ {7 V - task_5();
# N s& v+ @2 X- W& q9 y2 _ - }
# M' B/ ]6 z2 S) Q - else
: Q% j( @( c& W& L5 H/ ^2 H7 j- S - { x' J8 U g W9 P
- MC_ProgramTorqueRampMotor1(0, 0);6 D5 N' G! l3 k* M( s
- MC_StopMotor1(); B6 Z' J- l" w! {+ ^9 ]
- }
, i% o3 b1 D* \- k3 t1 t( k4 |% G - realspeed = MC_GetMecSpeedAverageMotor1()*6;) A; d' ]. Z; j( E; E5 g
- /* USER CODE END WHILE */) s3 l% D1 d; [, K3 ^& b
# r: b9 f6 }1 Y' a$ i: b/ p7 R- /* USER CODE BEGIN 3 */
9 }: ]% I- I7 T8 ~$ w: P8 Q# }0 X - $ }% }0 J p B5 C) W8 P4 \3 G
- }: e; s! z/ @, c* a _, \4 D$ ^
- /* USER CODE END 3 */
- {2 t' f- A0 k; r8 c* s7 s' b
复制代码其中5000是通过任务4测试出来的,900是通过任务5测试出来的,维持最低转速需要转矩参考量给到900。
' i" H1 u( _! m+ }8 D' q* c, p( W* O
实验现象:* D( _+ Z, v, `) B/ ?& ?6 y
7 D4 B2 \5 q! s# I3 h: p" s这个任务虽然完成了但是留下了一些疑问,还需要一段时间去深入了解代码所做的事情。 & U8 Y/ f1 P8 s( Q* ^9 h$ V+ K9 Y
! o( ^8 q1 n, S, L) n
一些疑问和吐槽: 1.在做这个任务的时候,想吐槽一下电机库这个结构体,传指针是对于阅读代码来说不是很友好,另外就是有些结构体写得不够明白,比如存储dq轴电流、电压的这个结构体 ; l9 m. m. Z! ^: T3 Q
- typedef struct
5 A. \0 o6 U5 C+ \+ R - {2 u1 V1 `) v- {1 n) ~# D& \; x
- int16_t qV_Component1;
' B" f# T! W1 W7 Z M1 t - int16_t qV_Component2;
. S+ g& R5 x1 u2 Y# w3 ` - } Volt_Components;
, P8 I4 H1 O* P
复制代码从结构体自身来看,结构体由组件1和组件2构成,但是这个在使用中并不能很好的明白组件1和组件2代表的意思,我看到电机库代码中结构体命名都是Vqd、Iqd这种形式,但是按照大家的习惯可能会把字母符号排在靠前的放前面,如Vdq、Idq这种。也许是我涉足代码不够深入,不了解ST工程师的想法,这里仅提出一点我自己的看法。 8 @! a/ Z" D' |2 }
2 ?5 Z I5 u a' P) O1 k. U3 u" }9 u9 N% R, i
2.接口函数注释描述不是很清晰,比如这个转矩模式的接口函数,我不能知道转矩设定值的限制大小或者通过某种算法来获取转矩参考值。好在我仿真任务4的时候可以查看q轴电流设定值的大小。 0 e, ]+ V* J4 }4 F. i4 W2 F
2 O( t8 K, t1 L* {" H' u0 q0 U" Z& D
3.转矩模式启动的时候速度会有一个过冲过程,通过仿真调试可以看到在启动的时候iq给定值非常大,过一会儿又降下来了,可能是满转矩启动造成的,后面要好好研究一下启动部分的代码了。
! _1 u. L; m f6 [' K( T4.我遇到的关于编译器的问题,不知道是否是因为工程过于庞大,我用MDK5.25进行仿真的时候出现了编译器类似死机的现象,电机套件正常运行,watch窗口里的变量没有变化。我新建了IAR的工程,仿真的时候不会出现这个问题,不知道各位有遇到过没
0 i2 `1 x) j8 S0 H7 D6 A7 q& g6 a* N2 p0 _9 W
ok,今天的分享就到这里,欢迎大家留言讨论。
: K/ V- C. E+ K; I; ~2 D
( h+ Q" W; ]/ N, @' M% y) A% `! o" }9 s; ?# Z! d( @: N$ x! _& r
p: n* E! {* E" t: h
0 K4 b/ F: P& V1 k |
目前没有合适的负载,只能靠电机转轴上的两颗螺钉增加一点负载
不太明白你提问的意思,闭环控制都是相同的构造,pid参数提供给pid函数,比如你写的增量式或位置式pid函数。要实现位置环控制只需要得到当前位置和目标位置,即可通过pid函数调节。
有位置环的电机控制系统一般有三层控制环,最外是位置环,中间速度环,最里面是电流环,越是里面的是环调节速度应该越快
评分
查看全部评分
不好意思描述的有问题,我现在写的是位置式的PID函数,最后PID计算出值是提供给速度环的Idq ref吗
速度环输出才是Idq ref,位置环的输出应该是速度参考值,过程是这样的:角度参考值->位置环pid函数->速度参考值->速度环pid函数->电流参考值(Idq ref)->电流环PID函数->dq轴电压矢量->SVPWM
评分
查看全部评分
好的,谢谢大神
你看ST的培训资料吧,我第三篇帖子就说了整个工程我们需要关心的内容,你没看?分析一下他的状态机画画图就明白了
这个倒没测试过,后面找时间测试一下吧