嵌入式电机控制：M/T法测速与开关磁阻电机换相算法详解

1. 项目概述与核心价值

在嵌入式电机控制的世界里，速度和位置是驱动一切动作的基石。无论是让机械臂精准定位，还是让风扇平稳运行，控制器都需要实时、准确地知道电机“跑”得多快、转到了哪里。速度计算，这个看似基础的环节，恰恰是决定整个控制系统性能上限的关键。它不仅是实现PID闭环控制、抑制转速波动的必要输入，更是高级功能如转矩控制、效率优化的前提。

然而，把速度算准、算快，在资源受限的嵌入式微控制器上并非易事。你可能会遇到编码器脉冲抖动带来的噪声、低速时分辨率不足、高速时计算溢出等一系列头疼的问题。更复杂的是，对于开关磁阻电机这类结构特殊、控制逻辑迥异的电机，如何根据转子位置精确地开通和关断对应的相绕组（即换相），直接决定了电机能否启动、运行是否平稳、效率是高是低。

今天，我们就来深入拆解一个经典的电机控制库中关于速度计算和开关磁阻电机换相的核心算法。这份资料源自飞思卡尔（现恩智浦）早期的DSP电机控制库，虽然年代稍远，但其设计思想清晰、实现扎实，是理解底层电机控制逻辑的绝佳范本。我们将不仅仅停留在API手册的翻译层面，而是结合我十多年在工业伺服和消费电子电机驱动上的踩坑经验，把每个参数背后的物理意义、算法选择的权衡、以及实际部署时那些手册里不会写的注意事项，都掰开揉碎了讲清楚。无论你是正在评估控制方案，还是调试中遇到了转速跳动、换相失步的难题，相信这篇详尽的解析都能给你带来直接的启发和可落地的参考。

2. 速度计算的核心原理与两种经典方法

速度，在旋转运动中就是角速度，单位通常是每分钟转数（RPM）。在数字控制系统中，我们无法直接测量一个连续的速度信号，只能通过离散的“采样”来估算。最直接的思路有两种：要么固定时间去“数”位置变化了多少，要么固定位置变化去“测”用了多少时间。这两种思路，就对应了资料中提到的velocityFixPer和velocityFixPos两个函数。

2.1 方法一：固定周期法（M法测速）——velocityFixPer

这种方法在工程上常被称为“M法测速”。它的逻辑非常直观：我们在一个固定的、周期性的时间窗口（比如每10毫秒）内，读取编码器或霍尔传感器反馈的位置增量值。速度就等于位置变化量除以时间。

公式核心：速度 (v) = (位置差 * 60) / (固定周期 T)

在提供的APIvelocityFixPer(Frac16 PositionDifference, UWord16 FixPerConst)中：

• PositionDifference：就是在一个固定采样周期T内，电机转过的机械角度（或圈数）。它是一个归一化的分数，范围在[-1, 1)之间，对应[-x_max, x_max]的实际位置变化。正负号代表方向。
• FixPerConst：这是一个关键的计算常数。它封装了固定周期T和系统最大可测量速度v_max（或v100%）的映射关系。根据资料中的公式推导：FixPerConst = 32768 * (v_max / v100%)。这里的32768对应Q15格式（Frac16）的1.0标么值。

为什么需要这个常数？直接使用(位置差/时间)在定点数DSP上运算涉及除法，且结果的范围可能很大或很小。通过预计算FixPerConst = 60 / T的缩放版本，函数内部只需进行一次乘法PositionDifference * FixPerConst，即可直接得到归一化后的速度值，计算高效且易于进行后续的限幅和处理。

实操要点与避坑指南：

1. 采样周期T的选择：这是一个权衡。T太短（如1ms），在低速时位置增量可能为0或很小，导致速度计算分辨率低，波动大；T太长（如100ms），系统动态响应慢，无法及时反映速度变化。通常，T应远小于控制系统速度环的周期（例如1/5到1/10），同时保证在最低速时，一个周期内也有足够的位置脉冲数。对于1024线的编码器，如果最低速要求分辨率为1RPM，那么T内至少需要1024/60 ≈ 17个脉冲，T至少需要17 / (1024*1/60) ≈ 1秒，这显然动态性太差。因此，在超低速时常需结合下文的方法二。
2. v_max与v100%的设定：v_max是理论上根据最大位置差和周期T算出的极限值（v_max = 60 * x_max / T）。而v100%是你希望速度输出范围对应的实际值。通常令v100% = v_max，此时FixPerConst = 32768。但有时为了预留余量或匹配其他模块，可以设置v100% < v_max。务必注意：如果实际速度超过v100%，输出值将饱和在±1.0。
3. 位置差的计算与方向处理：获取PositionDifference时，必须处理编码器计数器的溢出和方向。对于32位计数器，做差即可；对于16位计数器，需要考虑溢出翻转。方向信息通常编码在最高位或通过另一个变量传递，在计算差值时需要将其还原为有符号数。

2.2 方法二：固定位置间隔法（T法测速）——velocityFixPos

这种方法被称为“T法测速”。它的思路反过来：我们不去固定时间，而是固定一个位置变化量（比如编码器的1个完整周期，或1/512圈），然后测量电机转过这个固定角度所花费的时间。速度与这个时间成反比。

公式核心：速度 (v) = (固定位置间隔 X * 60) / (所用时间 t)

在APIvelocityFixPos(Frac16 PeriodTime, Word16 FixPosConst)中：

• PeriodTime：电机转过一个固定机械角度X所花费的时间。它同样被归一化到[-1, 1)区间，对应[-t_max, t_max]的实际时间。正负代表方向。
• FixPosConst：这个常数封装了固定位置间隔X和系统最小可测量速度v_min的映射关系。根据公式：FixPosConst = 32767 * (v_min / v_max)。其中v_max = k * v_min，k是一个大于1的整数，推荐50-100，用于设定速度量程。

为什么这种方法适合低速？在极低速时，固定周期法可能数个周期都看不到位置变化。而固定位置间隔法，只要电机在动，就一定能测到时间。速度越低，转过固定角度的时间t越长，测量反而越精确。但它的缺点是高速时，时间t非常短，对计时器的分辨率要求极高。

参数设定与计算示例：假设我们选择固定位置间隔为1/512圈（即编码器每512个脉冲为一个测量单元），计时器时间标度设定为0.2秒对应PeriodTime = 1.0。

• 最小可测速度v_min = (60 * (1/512)) / 0.2 ≈ 0.586 RPM。
• 若取k=100，则最大可测速度v_max = 100 * 0.586 = 58.6 RPM。
• 计算常数FixPosConst = 32767 * (0.586 / 58.6) = 32767 * 0.01 = 327（取整）。

重要警告：资料中特别指出，PeriodTime的绝对值必须大于等于FixPosConst对应的归一化时间，否则函数返回不准确。这对应着实际速度不能超过v_max。在实际编程中，必须在调用函数前对PeriodTime进行限幅处理，确保其不小于FixPosConst / 32767（即v_min / v_max）。

2.3 两种方法的对比与融合应用

在实际的高性能伺服驱动器中，常常采用混合（M/T）法来兼顾宽速域。基本思路是：在高速区，采用M法；当速度低于某个阈值时，自动切换到T法。切换逻辑需要仔细设计，避免在切换点附近速度计算值跳动。另一种更优雅的做法是使用频率-周期双模观测器，同时维护基于时间和基于位置的两种速度估计，并进行加权融合，但这需要更复杂的算法实现。

3. 开关磁阻电机换相算法深度解析

开关磁阻电机以其结构简单、成本低、高速性能好等优点，在一些特定领域（如家电、泵类、高速主轴）占有一席之地。但其控制的核心难点——换相，与永磁同步电机或直流无刷电机有本质不同。SRM的转矩来源于磁阻最小化趋势，而非磁场相互作用，因此必须在电感上升区对相绕组通电，在电感下降前及时关断。

3.1 SRM换相的基本原理与控制挑战

开关磁阻电机的转矩公式可以简化为：T = (1/2) * i^2 * (dL/dθ)。其中i是相电流，dL/dθ是电感随转子位置θ的变化率。由此可见：

1. 正向转矩只在dL/dθ > 0（电感上升区）时产生。通电区间必须严格匹配这个区域。
2. 转矩与电流平方成正比，与电流方向无关。因此功率电路通常使用不对称半桥，只需单向电流。
3. 换相时机至关重要。开通角（θ_on）和关断角（θ_off）的选取，直接影响平均转矩、转矩脉动、效率和噪声。

资料中介绍的srmcmt3ph2spp系列函数，就是针对三相、每相两个开关（不对称半桥）这种最常用拓扑的换相处理器。它不负责决定θ_on和θ_off的时刻，而是根据上层逻辑给出的指令，生成正确的功率管开关序列。

3.2 换相处理器数据结构与初始化

所有换相操作都围绕一个核心数据结构srmcmt3ph2spp_sData进行。理解其成员是理解整个流程的关键：

• cmt_ctrl：换相软件控制使能寄存器。它的低6位（Ab, At, Bb, Bt, Cb, Ct）分别控制A、B、C三相的下管（bottom）和上管（top）是否由软件（本算法）控制。置1表示软件控制，置0则可能由硬件或默认状态控制。初始化时，通常将所有位置1，取得完全控制权。
• cmt_out：换相输出控制数据寄存器。同样低6位，定义各开关管的目标输出状态（1=开通，0=关断）。真正的PWM硬件寄存器会受cmt_ctrl屏蔽后，根据cmt_out来驱动。
• cmt_ptr_phase_on,cmt_ptr_phase_off,cmt_ptr_phase_sw：这三个指针是状态机的核心。它们分别指向下一次应该开通、关断、进行软/硬开关的相位（A=1, B=2, C=3）。每次执行相应的函数后，指针会根据旋转方向自动更新到下一个相位。

初始化函数srmcmt3ph2sppInit必须首先被调用。它的作用一是根据start_phase参数初始化上述三个相位指针，确保电机从正确的相位开始启动；二是将cmt_ctrl全部置位（取得控制权），并将cmt_out全部清零（关闭所有开关管），确保系统从一个确定、安全的状态开始。

3.3 四步换相流程详解

资料中的图6-1和代码示例6-1清晰地展示了一个完整的换相周期，它由四个步骤组成，分别由四个函数触发：

第一步：相位开通 (srmcmt3ph2sppPhOn)

• 时机：在计算好的开通角θ_on时刻，由定时器比较匹配中断触发。
• 动作：根据cmt_ptr_phase_on指针，开通对应相位的上下两个开关管（见表6-4，例如开通A相时，cmt_out的 Ab, At 位都置1）。这相当于将该相绕组直接连接到直流母线电压上，电流开始快速上升。此函数执行后，cmt_ptr_phase_on指针按方向（A->C->B 或 A->B->C）更新。

第二步：软开关切换 (srmcmt3ph2sppSoftSw)

• 时机：在相位开通后第一个PWM重载中断中触发。这是一个非常关键但常被忽略的细节。
• 动作：根据cmt_ptr_phase_sw指针，将对应相位的上管控制权交给PWM硬件，而下管保持常开（见表6-8，开通A相后软切换，cmt_ctrl的 At 位清零，cmt_out的 At 位可能保持或忽略）。此时，该相进入PWM斩波调压模式，通常采用斩下管的方式（上管常开，下管受PWM控制）来调节电流。此函数更新cmt_ptr_phase_sw指针。

为什么需要“软开关”这一步？如果直接在θ_on时刻就开启PWM，由于电感电流不能突变，在第一个PWM周期内，如果占空比不是100%，下管关断时电流会通过上管的反并联二极管续流，母线电压会施加反向电压在绕组上，不利于电流的快速建立。先上下管全开，让电流在母线电压下快速建立到一个较高值，再切入PWM模式，可以获得更快的电流响应，减少转矩建立时间。这是SRM控制中的一个经典优化技巧。

第三步：相位关断 (srmcmt3ph2sppPhOff)

• 时机：在计算好的关断角θ_off时刻，由另一个定时器比较匹配中断触发。
• 动作：根据cmt_ptr_phase_off指针，关闭对应相位的上下两个开关管（见表6-6）。此时，绕组电流需要通过电机绕组和开关管反并联二极管形成的续流回路衰减。此函数更新cmt_ptr_phase_off指针。

第四步：硬开关切换 (srmcmt3ph2sppHardSw)

• 时机与作用：资料中描述略显模糊。通常，这一步并非在每个周期都调用。它用于在需要的时候（例如特定故障模式或控制模式切换时），将软件对开关管的控制权完全释放（将cmt_ctrl中对应位置零），让硬件或安全逻辑接管。在正常的PWM关断续流期间，并不需要调用此函数。

3.4 换相角度计算：让电流提前建立

对于高速运行的SRM，一个严峻的问题是：电感上升区的时间窗口非常短。如果等到转子到达对齐位置（电感最大处）才开始通电，电流根本来不及建立到所需值，导致转矩不足。因此，必须提前导通，即在转子尚未到达定子齿极时就开始通电，这就是超前换相角。

资料中提供的srmcacAngleCalc函数就是用于计算这个超前角θ_adv。其简化公式（忽略电阻）为：θ_adv = (L_un * i_desired / u_phase) * ω_actual

• L_un：非对齐位置电感。这是电流建立回路的主要限制因素。
• i_desired：期望达到的相电流峰值。
• u_phase：施加在相绕组上的电压（约等于母线电压乘以当前PWM占空比）。
• ω_actual：电机的实际机械角速度。

公式的物理意义：(L_un * i_desired / u_phase)代表在给定电压下，电流从0上升到i_desired所需的时间（因为di/dt = V/L）。将这个时间乘以角速度ω，就得到了需要提前的角度（电角度）。速度越高，这个角度就必须越大。

代码示例6-2的实践解读：

1. 参数标定：使用前必须根据电机参数（L_un,I_MAX,OMEGA_MAX）和系统量程（U_MAX,THETA_MAX）计算缩放常数scale_const。这个常数将物理量计算压缩到Q15格式的运算中。
2. 调用时机：该函数应在每次准备换相前被调用，根据当前的电流指令、母线电压和反馈速度，动态计算本次换相所需的超前角。
3. 角度合成：计算出的adv_angle是相对于“重叠开始点”（即电感开始上升的点，THETA_EDGE）的超前量。因此，最终的开通角theta_on = THETA_EDGE - adv_angle。这里使用减法，因为是在时间轴上向前（提前）移动。
4. 实现方式：示例中通过不断读取编码器位置position，并与计算出的theta_on比较，一旦超过即触发换相标志。这是一种软件查询方式。更高效的做法是利用定时器的输出比较功能，将theta_on转换为定时器计数值，直接产生中断，精度和实时性更高。

4. 从API到实战：系统集成与调试要点

理解了单个API，只是第一步。将它们有机组合成一个稳定、高效的嵌入式控制系统，才是真正的挑战。这里分享几个关键的实战经验。

4.1 速度计算模块的集成策略

1. 传感器接口层：无论是编码器还是霍尔传感器，都需要一个稳定、抗干扰的接口层。对于正交编码器，建议使用MCU的专用正交解码模块（QEI），并启用其4倍频计数以提升分辨率。对于霍尔传感器，需配置输入捕获功能，并编写消抖算法（通常采用10-100us的延时再采样）。
2. 速度计算任务调度：对于velocityFixPer（M法），将其放在一个固定周期的定时器中断（如1kHz）中执行。对于velocityFixPer（T法），应将其放在位置捕获中断（如编码器索引信号或每N个脉冲的软件分频）中执行。如果采用混合M/T法，则需要一个状态机来管理两种方法的切换和结果融合。
3. 低通滤波必不可少：计算出的原始速度值通常噪声很大，尤其是低速时。必须加入一阶或二阶低通数字滤波器。滤波器的截止频率需要仔细调整，要在滤除噪声和保持系统动态响应之间取得平衡。一个经验是，截止频率设为速度环带宽的5-10倍。
4. 方向处理与零速检测：速度值应包含方向信息（正负）。在接近零速时，由于传感器噪声和计算误差，速度值可能在零附近抖动，导致控制系统“抽搐”。需要实现一个零速死区，当速度绝对值小于某个阈值（如额定速度的0.1%）时，强制将速度输出置零。

4.2 SRM换相控制的系统框架

一个典型的SRM数字控制系统包含以下层次：

1. 位置/速度检测层：提供转子位置θ和速度ω反馈。
2. 换相逻辑层：核心就是本文所述的srmcmt3ph2spp模块。它接收来自上层的“开通”、“关断”、“软切换”命令，并输出具体的cmt_ctrl和cmt_out寄存器值。
3. 角度计算与调度层：这是控制策略的大脑。它根据速度指令、反馈速度、电流指令，利用srmcacAngleCalc或其他更复杂的算法（如考虑饱和、互感）动态计算θ_on和θ_off。然后，根据当前转子位置，调度换相逻辑层的三个动作（开通、软切换、关断）。调度通常由多个定时器输出比较（OC）模块实现，将角度转换为定时器计数比较值。
4. 电流调节层：在软开关切换后的PWM阶段，通过电流采样和PID/PI调节器，动态调整PWM占空比，使相电流跟踪其指令值。电流指令可能来自速度环的输出（转矩控制模式），也可能是固定的斩波限值（电流斩波模式）。
5. PWM驱动层：将cmt_ctrl和cmt_out的值写入MCU的PWM模块对应的影子寄存器，由硬件自动在下一个PWM周期更新输出，确保开关动作的同步性和安全性。

4.3 调试过程中常见的“坑”与解决思路

1. 电机启动抖动或失败：

   • 可能原因1：初始相位指针start_phase设置错误。SRM启动需要知道转子的初始位置。如果无传感器，通常采用“对齐”方式：依次给各相通一个短时小电流，由于电感随位置变化，检测电流上升率最大的相，其对应的就是最小电感位置（非对齐位置），反推即可得到初始位置。如果有传感器，则直接读取。
   • 可能原因2：开通角θ_on太小。在启动时转速为0，根据公式超前角也为0。如果θ_on设置得离对齐点太近，电流来不及建立。启动时应采用一个固定的、较大的超前角（如30度电角度）。
   • 排查方法：用示波器同时观察位置信号、相电流和PWM驱动波形。检查第一次换相触发时，转子位置是否在预期区间，电流是否开始上升。

2. 高速运行时转矩下降或失步：

   • 可能原因1：超前角θ_adv计算不准或未随速度调整。速度升高后，必须增大超前角。检查srmcacAngleCalc的输入参数（特别是u_phase和ω_actual）是否正确。
   • 可能原因2：关断角θ_off设置过晚。电流在电感下降区会产生负转矩。必须确保在电感开始下降前彻底关断。尝试逐步提前关断角，观察平均电流和转矩变化。
   • 可能原因3：PWM频率过低或电流环带宽不足，导致高速时电流跟踪不上指令。需要提高PWM频率或优化电流环PID参数。
   • 排查方法：在高速下，用示波器观察电流波形是否能在导通区间内达到指令峰值并保持平顶。观察关断后电流衰减是否迅速。

3. 换相时刻有较大的电流尖峰或噪声：

   • 可能原因：软开关切换时机不当。如果从全开通切换到PWM模式的时机太晚，电流可能已经超过斩波限值，导致切换瞬间产生冲击。尝试在电流上升到指令值的70%-80%时就进行软切换。
   • 排查方法：放大观察开通和软切换两个时刻附近的电流波形，看是否存在不连续或突变。

4. 速度计算值跳动大：

   • 对于M法：检查在低速时，一个采样周期内的位置增量是否过小（如小于3个计数）。如果是，考虑切换到T法或增加采样周期。
   • 对于T法：检查在高速时，测量时间PeriodTime是否接近计时器分辨率极限。如果是，考虑切换到M法。
   • 通用方法：检查传感器信号是否受到干扰（电源噪声、长线传输）。确保编码器电源稳定，信号线采用双绞线或屏蔽线。在软件中加入数字滤波。

5. 进阶思考：超越基础API的性能优化

官方库提供的API是可靠的基础，但在追求极致性能的应用中，我们还可以做更多。

1. 速度观测器：替代简单的M法/T法计算，采用状态观测器（如龙贝格观测器、滑模观测器）来同时估算速度和位置，并能有效抑制测量噪声，甚至在传感器故障时提供一定冗余。
2. 自适应换相角控制：srmcacAngleCalc的公式忽略了电阻和磁路饱和。实际中，电感L_un会随电流变化，电阻压降在低速时不可忽略。可以建立更精细的电机模型，或通过在线参数辨识、查表等方式来动态修正换相角。
3. 转矩脉动抑制：SRM固有的转矩脉动是其主要缺点。可以通过电流 profiling来实现：即不追求电流为方波，而是根据转子位置，给定一个特定形状的电流指令（如正弦波、梯形波或其变体），使得各相合成转矩更加平滑。这需要更复杂的离线计算或在线查表。
4. 无位置传感器控制：对于成本敏感或环境恶劣的应用，去掉位置传感器是趋势。可以通过检测相绕组的瞬态电感（通常通过注入高频脉冲或测量PWM关断期间的续流时间来实现）来估算转子位置。这在低速和零速下是巨大挑战，是目前SRM控制的研究热点。

回过头看，这份电机控制库文档虽然代码风格古朴，但其蕴含的“固定时间/固定位置测速”、“四步换相流程”、“超前角计算”等思想，至今仍是许多电机驱动产品的内核逻辑。理解它，不仅是为了调用几个函数，更是为了掌握电机控制中最本质的时空转换艺术——如何用离散的数字信号，去精准地驾驭连续的旋转机械运动。当你下次调试电机，听到它从嘶鸣到平稳鸣响时，或许就能体会到这些看似枯燥的算法背后，所蕴含的精确与力量。