8位MCU电机控制：定点数运算与PI控制器工程实践

1. 项目概述与核心价值

在资源受限的8位微控制器（MCU）上实现电机控制，就像用一把瑞士军刀去完成精细的木工活。它要求开发者必须在极其有限的算力、内存和时钟周期内，实现高实时性、高精度的控制算法。这其中的核心挑战，往往不是控制理论本身，而是如何将理论中的浮点运算、连续时间模型，“翻译”成MCU能高效执行的定点数运算和离散时间代码。Motorola（后为Freescale，现为NXP）早年推出的这款8位电机控制算法SDK，正是为解决这一痛点而生。它不是一份简单的函数列表，而是一套经过实战检验的工程化解决方案，将电机控制中最基础、最关键的数学运算和控制器模块，封装成了可直接调用的API。

这套SDK的核心价值在于其“针对性优化”。它没有追求大而全的数学库，而是精准聚焦于电机控制算法中最高频、最影响性能的操作：饱和加法/减法、带符号/无符号的定点乘除法、数值限幅、以及基于查表法的三角函数计算。同时，它提供了多种形态的PI控制器实现，从最基本的controllerPI_8到带独立输出限幅的controllerPI_Lim_8，覆盖了从电流环到速度环的不同应用场景。对于从事家电（如变频风扇、洗衣机）、小型工业设备（如泵、传送带）或消费电子（如云台、玩具）电机控制的工程师而言，这份文档和其背后的代码，是绕过许多“坑”、快速搭建稳定控制系统的宝贵起点。它教会我们的，不仅是如何调用函数，更是在8位平台上进行算法设计的底层思维：如何权衡精度与速度，如何处理溢出与饱和，如何将控制参数“映射”到有限的数值表示范围内。

2. 基础分数数学库深度解析

2.1 定点数表示与Q格式

在深入函数之前，必须理解SDK所采用的数值表示法。8位MCU通常没有硬件浮点单元（FPU），直接使用浮点数（float、double）会带来巨大的时间和空间开销。因此，SDK采用了定点数（Fixed-Point）表示法，用整数来模拟小数。

文档中频繁出现的SByte（有符号8位，范围-128~127）和SWord16（有符号16位，范围-32768~32767），就是定点数的载体。关键在于理解它们的Q格式（Q-Format）。虽然没有在文档中明说，但结合电机控制上下文，可以推断其常用的格式：

• Q7格式（对于SByte）：将一个8位有符号整数解释为一个小数，其最高位（bit7）是符号位，其余7位（bit6-bit0）表示小数部分。数值范围是 -1（0x80） 到 约 +0.992（0x7F）。数值1实际上用127(0x7F) 表示，-1用-128(0x80) 表示。
• Q15格式（对于SWord16）：将一个16位有符号整数解释为一个小数，最高位（bit15）是符号位，其余15位表示小数部分。数值范围是 -1（0x8000） 到 约 +0.99997（0x7FFF）。数值1用32767(0x7FFF) 表示。

这种表示法的优势是，加减法可以直接进行，而乘除法则需要额外的缩放操作来保持精度。SDK中的数学函数，本质上就是在高效、安全地处理这些缩放和溢出问题。

2.2 核心算术函数：饱和与溢出处理

这是整个数学库的基石。在控制系统中，数值溢出会导致灾难性的不稳定（例如，积分器饱和导致控制量突变）。SDK的函数普遍内置了饱和（Saturation）处理。

以add和add_8函数为例，它们并非简单的return x + y。当x+y的结果超出目标数据类型的表示范围时，函数会返回该类型的最大值或最小值。例如，对于SByte，add_8(100, 30)的结果是127（饱和到上限），而不是130（会溢出变成负数）。查看其汇编实现（标记为fa），通常会使用条件判断指令，在溢出发生时将结果钳位到极值。

实操心得：理解饱和的代价饱和处理增加了额外的判断分支，意味着最坏情况下的执行时间（Clock Cycles）会比典型情况长。如表1-2所示，add函数典型58周期，最坏62周期。在设计高实时性中断服务程序（ISR）时，必须考虑最坏执行时间，确保不会错过下一个控制周期。如果确定你的运算范围不会溢出，可以考虑使用不饱和的版本（如果SDK提供），或者自己内联汇编实现，以换取更确定的执行时间。

2.3 乘除法的精度与实现技巧

定点数乘除法是精度损失的重灾区。SDK提供了几种不同位宽的乘法：

• smul_8(SByte x, UByte y)：返回SWord16类型的x*y。这是最直观的乘法，8位乘8位得到16位结果，没有精度损失。常用于增益系数（UByte y）与误差信号（SByte x）的乘法。
• smul_16x8(SWord16 x, UByte y)和umul_16x8(UWord16 x, UByte y)：这两个函数非常关键。它们的描述是result = x(L) * y/256 + x(H) * y，看起来复杂，其本质是return (x * y) >> 8。这里y被当作一个Q8格式的无符号小数（范围0~255对应0~0.996）。乘法结果是一个24位或32位的数，右移8位（除以256）后，取低16位作为结果。这实现了16位数与一个8位小数的乘法，结果仍为16位，是PI控制器中积分项计算的典型操作。

除法函数sdiv_8和udiv_16to8则更为宝贵，因为在8位MCU上实现一个稳健的除法例程并不容易。sdiv_8(SWord16 x, UByte y)实现了16位有符号数除以8位无符号数，返回8位有符号数。它内部很可能采用了恢复余数法或非恢复余数法的除法器实现。需要特别注意其边界条件：当除数y=0时，函数根据被除数符号返回饱和值（127或-128），这避免了除零错误导致系统崩溃，但调用者必须意识到这是一个异常状态。

2.4 三角函数：空间换时间的经典策略

sinPIxLUT函数是电机控制波形生成（如SVPWM）的核心。它通过查表法（Look-Up Table, LUT）计算正弦值。文档指出它使用了一个256x8位的查找表。这意味着它将一个周期的正弦波（0~2π）离散化为256个点，每个点的正弦值用一个8位数（Q7格式）存储。

函数输入phase是一个16位数（0x0000~0xFFFF），对应 -π 到 +π（或0到2π，取决于约定）。函数内部会取phase的高8位作为索引（因为256点），从表中读取正弦值，再与amplitude（Q8格式，0~255对应0~1）进行乘法缩放。这种方法的执行时间非常稳定（75~81周期），远快于任何级数展开计算。

注意事项：表的内容决定波形质量文档特别强调：“生成的波形形状取决于存储在正弦表中的数据。在电机控制应用中，数据通常描述纯正弦波或带有三次谐波注入的正弦波。” 这意味着，开发者可以根据需要定制这个表。例如，注入三次谐波可以提升直流母线电压利用率约15%。你需要自己生成这个表的数据，并链接到项目中。表的精度（8位）和大小（256点）是权衡波形质量和内存占用的关键。

3. PI控制器API的工程化实现

3.1 控制器结构体与离散化模型

SDK中的PI控制器围绕sPIparams结构体展开：

typedef struct { UByte ProportionalGain; // Kp * 缩放因子 UByte IntegralGain; // Ki * 采样周期T * 缩放因子 SWord16 IntegralPortionK_1; // 上一拍的积分项 uI(k-1) } sPIparams;

这里蕴含了几个重要工程细节：

1. 增益的整型化：Kp和Ki这些浮点数参数，必须在离线时乘以一个合适的“缩放因子”（Q格式转换），转化为UByte才能使用。这个缩放因子需要结合被控量（如电流、速度）的物理量纲、ADC采样分辨率、PWM占空比范围共同确定。
2. 积分项的存储：IntegralPortionK_1是控制器的“状态”，必须在控制器调用之间持久保存。这通常定义为全局变量或隶属于某个电机实例的结构体成员。初始化时务必清零，否则会导致上电瞬间输出异常。
3. 离散化方法：文档明确使用了后向欧拉法（Backward Euler）进行离散化。其积分项的递推公式为：uI(k) = uI(k-1) + Ki * e(k)。后向欧拉法在Z域上更稳定，尤其适合这种定点实现。与之对应的前向欧拉法公式为uI(k) = uI(k-1) + Ki * e(k-1)，稳定性稍差。

3.2 四种控制器变体的应用场景

SDK提供了四个PI控制器函数，它们的区别正是为了应对不同的工程需求：

• controllerPI_8：最基础版本。输入（期望值、测量值）为8位，输出为16位。所有内部计算都进行饱和处理。适用于环路带宽要求不高、被控量动态范围较小的场景，例如某些速度环。
• controllerPI_Scl_8：带误差缩放的版本。多了一个scale参数，用于对误差e(k)进行左移放大（e(k) << scale）。这有什么用？当你的Kp和Ki非常小（比如小于1）时，在Q格式下用8位整数表示会损失大量精度（可能只能表示0或1）。通过先将误差放大，再用较大的整数增益参数，可以等效地实现小增益的控制，从而提升控制精度。scale每增加1，相当于增益分辨率提升一倍。
• controllerPI_Lim_8：带独立积分抗饱和限幅的版本。这是最实用、最推荐的版本。它允许为控制器总输出u(k)和积分项uI(k)分别设置正负限幅（PositivePILimit,NegativePILimit）。积分抗饱和（Anti-Windup）是工程中防止系统“失控”的关键技术。当输出因执行机构（如PWM）达到物理极限而饱和时，如果积分器还在不断累积误差，会导致系统超调严重、恢复缓慢。controllerPI_Lim_8通过限制积分项的增长，有效缓解了这一问题。两个限幅值可以设为相同（通常等于PWM的最大/最小占空比），也可以让积分项限幅更宽松一些，以保留一定的积分能力。
• controllerPI：16位输入版本。输入输出均为16位。用于需要更高控制精度的场合，例如高性能的电流环控制，其中电流反馈值来自高分辨率的ADC。

3.3 参数整定与定点数转换实战

纸上得来终觉浅，我们以一个具体的电机速度环为例，说明如何将理论PI参数转化为SDK可用的整型参数。

假设：

• 电机速度设定范围：-1000 ~ +1000 RPM。
• MCU的ADC读取速度，经换算后，满量程1000RPM对应SByte最大值127。即，1 RPM ≈ 127 / 1000 = 0.127个LSB。我们选择Q7格式，127代表1.0，即1000RPM。
• 理论计算（或在MATLAB/Simulink中仿真）得到的浮点PI参数为：Kp = 0.5,Ki = 0.1。采样周期T = 0.001s(1kHz)。
• PWM占空比输出范围为 -100% ~ +100%，用SWord16表示，即-32767 ~ +32767(Q15格式，32767代表1.0)。

转换步骤：

1. 确定误差缩放：速度误差e(k)是8位数。Kp=0.5小于1，直接用量化会精度不足。我们选择使用controllerPI_Scl_8，并令scale = 1，即先将误差左移1位（放大2倍）。
2. 计算整型ProportionalGain：
   • 比例项计算：uP(k) = Kp * e(k)
   • 在定点运算中，e(k)是 Q7，Kp是浮点数。我们需要将Kp转换为一个UByte增益Kp_int，使得Kp_int * (e(k) << scale) / 256的结果等于Kp * e(k)的 Q15 表示。
   • 推导公式：Kp_int = Kp * 2^(8 + scale) / (速度量纲缩放因子)。这里，2^8是因为乘法后右移8位；scale是误差放大倍数；分母是速度从物理量到Q7的缩放系数（本例为127/1000）。
   • 计算：Kp_int = 0.5 * 2^(8+1) / (127/1000) ≈ 0.5 * 512 / 0.127 ≈ 2016。这超出了UByte范围。说明我们的scale不够。尝试scale=2（放大4倍）。
   • Kp_int = 0.5 * 2^(8+2) / (0.127) = 0.5 * 1024 / 0.127 ≈ 4031，仍然太大。这说明对于这个系统，Kp=0.5相对于我们的数值表示来说太大了。我们需要重新审视理论参数，或者调整速度的标幺化基准。这是一个关键的调试点：理论参数必须适配定点数的表示范围。假设我们调整理论Kp = 0.2。
   • Kp_int = 0.2 * 1024 / 0.127 ≈ 161。这个值在0~255范围内，可行。我们取整为161。
3. 计算整型IntegralGain：
   • 积分项离散公式：uI(k) = uI(k-1) + Ki * T * e(k)
   • 同理，Ki_T_int = Ki * T * 2^(8+scale) / (速度量纲缩放因子)
   • Ki_T_int = 0.1 * 0.001 * 1024 / 0.127 ≈ 0.806。取整为1。这里暴露了一个问题：Ki太小，经过采样时间和定点转换后，整型增益可能只有0或1，积分作用非常微弱甚至消失。这可能需要增加scale到3，或者增大采样周期T，或者在理论设计时就考虑离散化后的有效性。
4. 确定限幅值：PWM输出范围对应SWord16的-32767 ~ +32767。因此，NegativePILimit = -32767,PositivePILimit = 32767。

经过这番换算，你才能将Kp=0.2, Ki=0.1这个浮点参数，转化为ProportionalGain=161, IntegralGain=1, scale=2的整型参数，用于controllerPI_Scl_8函数。这个过程是8位MCU电机控制开发中最具挑战性的环节之一。

4. 算法集成与系统构建指南

4.1 内存与时钟周期评估

在8位系统中，资源寸土寸金。SDK文档中表1-2和表2-3提供的“内存消耗（Size）”和“时钟周期（Clock Cycles）”数据至关重要。以controllerPI_Lim_8为例，其代码大小为273字节，执行时间典型值为416个周期。

• 内存规划：如果你的MCU只有2KB RAM和32KB Flash，你需要计算所有数学库函数、控制器函数、以及你的应用代码、数据表格（如正弦表、V/Hz表）的总和。确保留有足够余量（通常20%-30%）用于调试和后期扩展。
• 实时性评估：假设你的PWM开关频率为16kHz，则控制周期为62.5微秒。如果MCU主频为8MHz，一个时钟周期为0.125微秒。那么controllerPI_Lim_8的416周期约耗时52微秒。这意味着仅一个PI控制器就占用了超过80%的单周期时间。你还需要时间执行ADC采样、坐标变换（如果做FOC）、其他保护逻辑等。这迫使你必须在更低的开关频率、更简化的算法、寻找更快的MCU之间做出权衡。

4.2 中断服务程序中的调用规范

电机控制算法通常在一个定时器中断（与PWM中心对齐）中执行。以下是一个典型的速度环中断服务程序伪代码框架：

#pragma interrupt save_all void PWM_ISR(void) { // 1. 清除中断标志 CLEAR_PWM_IF; // 2. 读取ADC结果，获取当前速度（measuredSpeed_SByte） measuredSpeed_SByte = (SByte)((ADC_RESULT_HI << 8) | ADC_RESULT_LO) >> 4; // 假设12位ADC右对齐，取高8位并转换为SByte // 3. 调用速度PI控制器 // desiredSpeed_SByte 来自上位机或电位器 speedPwmOut_SWord16 = controllerPI_Lim_8( desiredSpeed_SByte, measuredSpeed_SByte, &speedPI_params, // 全局或静态变量 NEGATIVE_LIMIT, POSITIVE_LIMIT ); // 4. 将PI输出转换为PWM占空比并更新寄存器 // 假设PWM周期寄存器值为PERIOD pwmDuty = (PERIOD / 2) + (speedPwmOut_SWord16 * PERIOD / 2 / 32767); // 转换为单极性调制 UPDATE_PWM_DUTY(pwmDuty); // 5. 启动下一次ADC采样（可能采用PWM触发ADC） START_ADC_CONVERSION(); }

关键技巧：避免在中断内进行复杂计算sinPIxLUT这类查表函数虽然快，但仍需数十周期。如果系统中需要同时生成三相正弦波（调用3次），开销不小。可以考虑：

1. 预计算：在速度环（外环）中计算好电压矢量的幅值和相位，在电流环（内环）或PWM更新中断中只进行查表和Park/Clarke反变换。
2. 分段执行：如果计算实在来不及，可以将一个控制周期的计算任务拆分到两个甚至多个PWM周期中执行，但这会降低有效控制带宽。

4.3 与SDK其他模块的协同

这份用户指南还提到了其他章节，它们与数学库和控制器共同构成完整的电机控制方案：

• 三相波形生成（Section 3）：mcgen3PhWaveSine等函数，很可能内部调用了sinPIxLUT，并根据输入的幅值、频率（或相位增量）生成三相PWM占空比。这是实现V/F开环控制或SVPWM的核心。
• V/Hz表（Section 4）：用于异步电机的V/F控制。通过查表方式，根据给定频率输出对应的电压幅值，以维持气隙磁通恒定。这避免了在线计算平方根或复杂函数。
• 死区补偿算法（Section 5）：这是工程中提升低速性能、降低转矩脉动的关键。通过检测电流极性，动态调整PWM占空比，补偿因功率管开关死区时间导致的电压损失。该算法通常作为一个独立的状态机运行。

5. 常见问题、调试技巧与避坑指南

5.1 数值振荡与极限环

现象：电机在稳态时，速度或电流在目标值附近有规律地小幅振荡，而不是完全静止。排查：

1. 检查量化误差：这是8位系统最常见的问题。当误差e(k)小于系统分辨率时，PI控制器的比例项和积分项可能由于取整操作而在0和1之间跳动。例如，误差实际为0.3，但用8位整数表示只能是0。这导致控制器持续输出微小扰动。
2. 解决方案：
   • 提升精度：使用controllerPI_Scl_8并增大scale，或者直接使用16位版本的controllerPI。
   • 设置死区（Dead Zone）：在控制器入口，当abs(e(k)) < threshold时，直接将误差置零。threshold根据系统分辨率设定。
   • 积分分离：仅在误差较大时投入积分作用，小误差时仅用比例控制。

5.2 系统响应迟钝或超调过大

现象：给定速度阶跃变化，电机响应很慢，或者严重超调后缓慢稳定。排查与解决：

1. 参数错误：首先检查Kp_int和Ki_int的换算是否正确。使用第3.3节的方法重新核算。一个快速验证方法是：将积分增益IntegralGain设为0，先调比例环。逐渐增大Kp_int直到系统出现轻微振荡，然后取该值的60%~70%作为比例增益。然后加入积分，从很小的值开始慢慢增大，直到静差被消除，且动态响应可接受。
2. 采样频率过低：采样周期T太长，无法捕捉系统动态。根据香农采样定理，采样频率至少是系统带宽的2倍，工程上通常要求10倍以上。检查你的控制中断频率是否足够。
3. 输出限幅过小：检查PositivePILimit/NegativePILimit是否设置正确。如果限幅值远小于PWM实际能输出的范围，控制器输出早早饱和，自然无法快速响应。

5.3 上电或负载突变时系统失控

现象：电机启动时猛冲，或突然加负载时速度暴跌甚至停转。排查与解决：

1. 积分器初始值：确认sPIparams结构体中的IntegralPortionK_1在系统初始化时被清零。如果它是一个随机值，上电第一拍就会输出一个巨大的不可控量。
2. 启用并正确配置积分限幅：务必使用controllerPI_Lim_8，并将积分项限幅（与输出限幅可以相同或略大）设置合理。这是防止积分饱和（Windup）的根本手段。在启动阶段，误差很大，积分器会快速累积，如果没有限幅，即使误差减小，积分项仍维持高位，导致严重超调。
3. 加入启动/切换策略：对于V/F控制，可以采用软启动（缓慢提升频率和电压）。对于闭环控制，可以在启动初期先开环运行一小段时间，待电机转起来、反电动势建立后，再切入闭环。

5.4 代码大小与速度优化

当资源紧张时，可以考虑以下优化：

1. 选择性链接：SDK的库文件可能是源代码或库文件。只把你用到的函数（如add_8,smul_16x8,controllerPI_Lim_8,sinPIxLUT）包含进工程，编译器会进行死代码消除。
2. 查表替代实时计算：对于V/Hz曲线、非线性补偿等，尽量使用查表法。虽然占用ROM，但执行速度极快。
3. 汇编关键路径：如果使用C语言调用，函数调用的开销（压栈、跳转、出栈）不容忽视。对于最内层、调用最频繁的循环（如电流环中的Park变换），可以考虑用汇编语言重写。
4. 降低三角函数表精度：如果256点的正弦表太大，可以尝试减少到128点甚至64点，并通过线性插值来提高波形质量，在速度和内存间取得平衡。

5.5 调试与监控手段

在资源受限的8位系统上调试，printf是奢侈的。必须依赖更底层的方法：

1. GPIO引脚翻转：在中断入口和出口用GPIO输出高低电平，用示波器测量中断执行时间，确保满足实时性要求。
2. PWM占空比映射变量：将关键的内部变量（如误差e(k)、积分项uI(k)）按比例映射到一个未使用的PWM通道的占空比上。用示波器观察该PWM波形，就能直观看到这些变量的变化趋势。
3. 利用ADC空闲通道：如果MCU有多个ADC通道，可以用一个通道来采样一个固定的、代表内部变量的模拟电压（通过RC电路或DAC生成），然后用另一个工具采集这个ADC结果进行分析。
4. 变量导出到RAM固定地址：将需要观察的关键变量声明在固定的RAM地址，通过调试器（如JTAG/SWD）或自定义的串口协议，在运行时读取这些内存内容。

这套Motorola 8位电机控制SDK，其代码本身可能已稍显陈旧，但它所蕴含的工程思想——如何在有限的资源下进行稳健、高效的定点数运算和闭环控制——至今仍然极具价值。它更像一份“地图”，指引你穿越8位电机控制这片充满约束的领域。当你真正吃透了这些基础函数背后的“为什么”，并成功地将它们组合成一个稳定运行的系统时，你对嵌入式控制的理解将会上升到一个新的层次。后续无论面对更复杂的32位ARM Cortex-M，还是更高级的FOC算法，这些底层积累都会让你游刃有余。