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

ST MC SDK5.x 电机库从系统到软件架构的详细说明

[复制链接]
gaosmile 发布时间:2020-3-19 12:10
1
总体软件架构  
MC SDK5.x 包含有芯片外设库,电机库和电机应用层三个主要部分,其中:
芯片外设库使用 ST HAL/LL 库,可被各个层级调用;
电机库则是主要的电机 FOC 控制层;最上层为电机应用层,供客户直接使用电机库,而不去关心底层如何实现的,加快用户程序开发;另外 MC SDK5.x 还提供 UI 库,用于界面调试通讯使用,比如和 Workbench 之间的交互就是通过 UI 库实现;
这里强调的一点是电机库是综合体,包含 FOC 算法,单片机外设配置,中断机制等各个环节,简单控制可能只需要关心电机应用层即可,如果复杂控制将涉及到整体操作。

  Z* T' `6 |* M$ J* v( ~* C

. P; L3 X) q% O
微信图片_20200319120008.jpg
! m" {" g& ?: h

9 f, l& r- `& b( o% z
在 SDK 使用过程中,电机本体、电机控制硬件板、控制管脚、控制策略在 MC workbench 中配置完成,顺序为 MC Workbench -> CubeMx 工程 -> 电机库代码(芯片外设库 + 电机控制库 + 电机驾驶舱 + 用户界面库 + 系统初始化),该生成代码加入简单 API 后(比如 MC_StartMotor1)可以直接运行对应电机,当需要细化控制或者复杂控制时才有可能涉及到修改电机驾驶舱或者电机控制库中的代码。
2 Q* b) E3 o0 v# k$ f

' K& o$ d7 B% Q& |! |- v
微信图片_20200319120012.jpg 4 d+ B0 X: e0 Z1 q; j8 G/ o9 x
6 ~2 J/ T6 D. H+ E) R( D5 M4 ^& T
1.1 芯片外设库
针对芯片的每种外设都有对应的库函数提供,需要结合 Cube 使用说明调用这些库函数; 电机库必须掌握的外设有 TIMER,ADC,GPIO。
+ W( w% y! R+ G; ?0 K. C8 E

: \% F' b5 k) c0 G! R
微信图片_20200319120015.jpg 6 `( E! q- T5 b: N8 ^1 L) m8 P
& s) c3 u; s' S. p6 Y
1.2 电机控制库文件及其说明
一般来说,普通应用这个部分不会涉及到,如果是在 API 层已经无法满足电机控制的需求时才会考虑修改这个部分,需要对电机运行框架非常熟悉的前提下去进行修改。
微信图片_20200319120019.jpg
, U! ^; s$ w3 M# n: r8 W
! J2 ~% q. @# n# F
1.3 电机驾驶舱
这个部分就是为客户直接使用电机库而准备的,各种 API 函数供用户调用;可以说简单应用或直接使用这些 API 函数足够达成电机控制应用,客户不需要关心底层如何操作,只需要关注自身需要实现哪些必要的功能,使得项目开发更加快速有效。

2 a0 h2 X5 z+ w, V/ R7 f
这里以一个马达控制函数为例:如果双马达控制的第二个马达则将后缀变为 Motor2,比如启动第二个电机的函数名为 MC_StartMotor2(),此处所涉及的除非特别说明,速度即为机械速度。

7 _/ f9 d0 X  q. n5 W8 }
& [8 A2 H' G- W& B
微信图片_20200319120023.jpg 6 w' N5 P, j+ t: [

  b2 H4 K" f1 v+ E6 N
微信图片_20200319120026.png ; A) @$ |+ n  f2 u$ ~
$ p) Q; _" b/ D
2
软件主要环路  
包含有三个主要环路:FOC 环路,安全环路,电机控制环路;虚线方框部分为可选择组件,实现部分为主要组件,可以看到整个控制围绕了电机控制系统的方方面面。
微信图片_20200319120030.jpg
6 d; w- G- E0 g) F
$ h8 {6 ?+ N/ M* h
3
整体软件框图  
可以看到上面的电机控制框图三个环路构成了底层驱动部分,对于整体程序流程上,电机库控制过程都发生在中断中,区别于普通顺序控制流程,也无任务调度;这样做可以将电机控制做到实时控制,因此整个 STM32 产品都可以用于 FOC 控制。 微信图片_20200319120034.jpg
0 Q, b/ I; V5 q0 f# A  O' \
3.1 Main函数
在 main.c 中主要是系统的初始化函数,main 函数更是条理清晰。
微信图片_20200319120037.jpg
' O1 v5 a( c' D/ e

. |* C9 d5 [7 q7 j3 k" k2 V! a
3.2 两个重要的中断
3.2.1 ADC 转换完成中断
3.2.1 ADC 转换完成中断
, i0 ?, D% C& R2 Q/ [9 \1 o3 n- ]
高频任务执行于 ADC 采样转换完成中断,ADC 采样开始由 TIM1 硬件触发,转换完成后进入中断,在这个中断中执行 FOC 坐标变换以及 SVPWM 的执行,最终控制 TIM1 的 PWM 占空比输出。

& ]) [* n0 N3 |8 a

( L0 |- a, j1 P
微信图片_20200319120040.jpg
7 |0 q4 }& \8 V0 y
注:XXX代表不同的芯片,不同采样策略对应的不同函数名称,比如STM32F302R8的三电阻采样方式xxx为r3_1_f30x,对应的文件名即为r3_1_f30x_pwm_curr_fdbk.c,对应的函数名称为R3_1_F30X_WriteTIMRegisters()

3 k4 r7 w6 Y0 P! o) V7 P& ?, G! Y
3.2.2 Systick中断
这个中断默认为 500us 的定时中断,安全任务执行在这个中断中,并且以 500us 为基础,中频任务也执行在这个中断中,比如我们设定的速度环执行为 2ms,实际是 500us*4,也就是四次 systick 中断后执行一次中频任务。
, i( Q1 y$ Z) n
2 l4 ^6 M5 c  |" ~
微信图片_20200319120044.jpg 8 [8 V1 N; {2 S3 h, B1 p
. S+ ?+ a0 E2 t) B+ P
4
三大任务流程

1 T, T3 i8 E% H- [7 M3 i$ r* }
4.1 高频任务
高频任务函数位于 mc_task.c 的 TSK_HighFrequencyTask()函数中,执行的是核心 FOC 算法。/ K+ F1 S# a, F4 Z

4 P1 w8 Y" |, ?) _# ^# z, A
- g& b0 Y7 d. H$ }  j0 D
微信图片_20200319120047.jpg
1 [$ ~+ F7 p5 z
- G5 h- w1 U: w% e/ t* s/ S
4.2 安全任务
所说的安全任务,字面意义已经很明确。这个部分对于过温、过流、欠压、过压保护进行判断,如果触发了上述保护,则会关闭 PWM 输出,复位电机控制参数,同时这个部分也是温度 ADC 采样,母线电压采样,用户 ADC 采样的执行地方。
6 X( \5 ~, g/ ?

& b( |; l9 ^; x5 y- ^8 \' O0 ]
微信图片_20200319120051.jpg ' Y' D4 k- u* {  P
& ^* W8 O# M2 E. k4 ~" O& M
4.3 中频任务
中频任务执行于 systick 中断中,实际为速度环以及状态机执行地方,同时包含有功率计算,如需要增加个人状态机,这个地方为添加点,同时注意根据传感器不同,平均速度获取函数也不同。

* e: _8 j9 O, j4 _
, N, |' @) J& d: s
微信图片_20200319120054.jpg
微信图片_20200319120059.jpg
微信图片_20200319120102.jpg & l+ k7 C' C( V* Z9 L
$ q; J, e' h. ^) K

. ^/ a; L& m2 K2 V0 D, K) `
5
附录
下面内容是就用户比较关心的电流,电压问题做必要说明。

+ S" E. ~2 q- N
5.1 三相电流获取
电流的采样在电机培训中提及,为硬件触发机制,TIM1 或者辅助 TIMER 触发 ADC 转换,转换结束后进入到 ADC 中断中,关于采样点选择,触发点请参看电机培训文档,这边不做过多描述;如果用户需要使用得到三相电流值,则可以通过几种方式获取,这边使用了基尔霍夫定理 Ia+Ib+Ic=0,因此取得 Ia,Ib 电流即可。
, v6 o" S6 X6 d
5.1.1 API 函数读取电流值
使用 API 函数 MC_GetIabMotor1(),返回值为 Curr_Components 这个结构体。
微信图片_20200319120106.png
微信图片_20200319120110.png
  o! ]8 E& f% E1 \8 w+ J- Z
  U3 }. y5 t3 N1 ~3 F
如果定义一个变量,则 Ia,Ib 分别是结构体变量的两个 int16 数据,如下所示:
7 d1 f* h& ?" {. a+ @, _- E& \) a" d
微信图片_20200319120113.png 7 S$ [/ o$ S% I% v3 e
  
5.1.2 利用已有的全局变量获取
我们看到在 mc_task.c 中有全局变量 FOCVars 这个变量,而这个结构体变量的其中一员即我们需要得到的 Ia,Ib 数据。. V  v/ }8 W9 Q. I3 ^0 w
微信图片_20200319120116.jpg
微信图片_20200319120120.jpg
# s1 l( Y. Y  i* @; c
' P$ i: e- e* e8 {. m

2 |& ^; O- g$ A# v9 n3 m
可以有下面的读取方式:
微信图片_20200319120123.jpg
& n/ Z3 _" b% P* y# o8 ?

" n- J' V4 O! Y
值得说明的是有些关注于底层 ADC 采样的用户很可能想到的是直接从 ADC 外设获取,很遗憾,在 ST 的电机库中 Ia,Ib 的数据得到非固定方式存在,即使使用了 Inject 注入通道进行采样,因为算法的灵活性 JDR1,JDR2 寄存器中存入的数据的意义是根据控制在变动的,比如 JDR1 可能 Ia,也可能是 Ib,因此该方式无法直接获取电流数据。
, j* ?( D. \6 F
5.2 母线电压的获取
在 API 函数中这个部分没有涉及获取函数,因此有必要在此做些说明。母线电压的读取部分在 TSK_SafetyTask()函数中执行,这边会得到一个平均值电压数据,这边简单介绍下获取过程,如果对这个部分不关心,可以忽略。
微信图片_20200319120126.jpg , y3 F1 J7 `" l: }5 Z0 e
2 e! B/ V* m& K# C+ y/ X, Z
5.2.1 函数获取方式
在 bus_voltage_sensor.c 中给出了两种电压格式函数,VBS_GetAvBusVoltage_d()返回的是母线电压的数字量,VBS_GetAvBusVoltage_V()返回的是以伏特(V)为单位的母线电压。

0 w" i; b( g5 B- A" M8 f
. V+ p" N) i! a) N7 h
微信图片_20200319120131.jpg
* g; Q( S" M, r8 |" n  J$ {
9 S3 i& a2 e6 D" E
这边需要使用的是 MCT 这个结构体组件,定义在 mc_task.c 中。

" H, t6 ]. \& _6 }& T/ @0 e  L
: S8 T: D8 @7 A
微信图片_20200319120135.jpg ( y# [# A$ {2 B8 U7 Z, r1 v
0 R, J6 s, q7 Q4 r. y) q1 @8 u  T
具体使用如下操作:
微信图片_20200319120138.jpg
) l  a3 A- z5 a5 W

" L0 g$ `% ]: y5 k& }( F4 S
5.2.2 全局变量取得母线电压
注意到在母线电压结构体定义过程,有直接的全局变量 RDivider_Handle_t,该结构体成员之一即为BusVoltageSensor_Handle_t _Super;这个我们所要的结构体。
微信图片_20200319120141.jpg
微信图片_20200319120144.jpg
( F5 E) ^' O! A% \

7 Q$ X9 R7 W0 X7 `! ]

* v* ^+ j* G$ N; P0 f
因此使用全局变量得到母线电压的操作如下,这边得到的是数字量的母线电压,如果需要转换为伏特则根据参数进行计算得到即可:
微信图片_20200319120147.png
) w: n! N8 U0 M6 E. H  T

' c0 k: b$ i2 \& d5 ~$ J* }
5.3 状态机操作
一般操作中不需要另外增加状态,如果需要在中频任务中增加自己的状态,假定添加的状态需要位于 START RUN 和 RUN 中间则需要有以下操作:
在 state_machine.h 的 State_t 结构体变量中增加状态,比如 USER_DEFINE_STATE = 21。
4 P+ \; u- Z9 n+ V

4 M- Q0 l' i$ g0 ~: l0 k: i
微信图片_20200319120150.jpg
6 {% I- s. _) v/ M! s$ x+ `4 l+ f

9 f7 x' m# q9 u' J! p2 k2 l
修改 mc_task.c 中频任务函数 TSK_MediumFrequencyTaskM1()中的状态跳转,START RUN -> USER_DEFINE_STATE -> RUN 同时增加一个新的状态 USER_DEFINE_STATE 分支语句。
: v4 Q; [8 C" E5 V0 V* D8 V

+ W" ^- H& Y0 {$ O
微信图片_20200319120154.jpg
9 D0 s) T, ^* ^6 l; i$ {" V
2 ~6 e% M: m2 a& t9 W2 U' V
因为涉及到状态跳转是否正确问题,还需要在 state_machine.c 中修改状态跳转的判断,做到承上启下的状态跳转,比如下面的判断修改:

- h# S! t, w; k# B8 P+ D

* y+ r* {6 p; e9 V  r  }. n& k
微信图片_20200319120158.jpg ( ]. r( c$ }2 l+ y" z6 \& X$ {
4 f9 A( Y; V- ^
上述为添加状态操作,删除操作或者是改变状态转移同样需要注意上下状态的切换,可以使用 STM_NextState()函数以及修改 state_machine.c 中修改状态跳转的判断灵活操作。

; w; \4 X4 G2 a; X  F, n* C
6
总结  
▼简单概括 MC SDK 整体框图,大家可以很清晰的看到三重架构,从下往上分别是外设层,电机库层,电机应用层;一般应用用户只需要熟练掌握电机应用层的 API 即可使用,用户可以从 ST 电机控制培训文档进行详细了解;
' z( D6 n3 N4 b' z( L
▼软件框架角度,因为主体控制位于中断服务程序中,需要关注 ADC 采样完成中断以及 Systick 中断;
* v; O9 T1 N/ U( t

4 H* ]* V: z" S, h( }0 D) e+ z
▼再深入研究,三大任务需要注意,高频任务,安全任务,中频任务;
▼高级应用则需要深入到电机底层库,详细掌握各个组件,进行相应的修改或者调用。
赞 收藏 6 评论3 发布时间:2020-3-19 12:10

举报

3个回答
liujun520168 回答时间:2020-5-15 16:10:49
谢谢分享,受益了
pengbosh 回答时间:2020-5-17 16:09:10
感谢楼上的分享啊
无法无天的艾伦 回答时间:2020-11-20 15:00:24
您好,大哥,我照您那样想看母线电压,        + _1 x; H" f+ J+ C: p+ X
Bus_Voltage_V = VBS_GetAvBusVoltage_d(MCT[M1].pBusVoltageSensor);
5 t: e0 J9 @6 a然后就报错,说没有定义MCT,可是他在task.c文件里边不是已经定义了么,
) t5 |; n( s1 ^, u: e3 e

这是在主函数的while上边加的

这是在主函数的while上边加的
QQ截图20201120145950.png
关于
我们是谁
投资者关系
意法半导体可持续发展举措
创新与技术
意法半导体官网
联系我们
联系ST分支机构
寻找销售人员和分销渠道
社区
媒体中心
活动与培训
隐私策略
隐私策略
Cookies管理
行使您的权利
官方最新发布
人形机器人运动控制、感知与智能配电
半导体创新技术与应用方向
EE架构与软件定义汽车
12V/48V 汽车智能配电(SPD)
区域控制单元(ZCU)与分区架构
关注我们
st-img 微信公众号
st-img 手机版