基于MC68HC705MC4的无刷电机控制：PID算法与六步换相详解

1. 项目概述与核心价值

如果你正在为一个需要精确调速、长寿命且低维护成本的嵌入式项目寻找电机控制方案，那么无刷直流电机（BLDC）几乎是绕不开的选择。我最近在整理一个老项目的技术档案时，重新翻出了基于摩托罗拉（现恩智浦）MC68HC705MC4这颗经典微控制器的无刷电机控制方案。虽然这颗MCU现在看来有些“古董”，但其高度集成的外设和清晰的控制逻辑，对于理解无刷电机控制的底层原理和经典PID算法实现，依然具有极高的教学和参考价值。

这个方案的核心，在于如何用一颗资源有限的8位单片机，可靠地完成电子换相、速度闭环控制和异常状态处理这三件大事。无刷电机没有电刷，转子的位置全靠霍尔传感器来“看”，控制器必须根据这个实时位置信息，像指挥交通一样，精准地控制三相逆变桥中六个功率管的开关顺序，这就是电子换相。而要让电机在面对不同负载时都能稳定在预设转速，就需要引入PID算法这个“大脑”，不断比较目标转速和实际转速的差异，并动态调整PWM的“油门”开度。

MC68HC705MC4的妙处在于，它把很多繁琐的硬件逻辑都集成在了片内：双通道带换相多路复用器的PWM模块，让你用几条简单的寄存器配置就能输出正确的驱动波形；输入捕捉功能可以精准捕获霍尔传感器的跳变沿，从而计算实时转速。整个控制内核的汇编代码不到300字节，CPU占用率在常规转速下也很低，留下了充足的资源给上层应用。接下来，我就把这个方案的硬件连接、软件流程，特别是PID算法的实现细节和调试心得，掰开揉碎了讲清楚。

2. 系统硬件架构与核心芯片解析

2.1 MC68HC705MC4：为电机控制而生的微控制器

MC68HC705MC4并非一颗通用型单片机，从其型号后缀“MC”就能看出，它是专为电机控制（Motor Control）优化的。在资源紧张的28引脚封装里，它塞进了对无刷电机驱动至关重要的几个外设。

首先是它的双通道PWM模块，每个通道都带有一个3引脚换相多路复用器。这是什么概念呢？通常驱动一个三相桥需要6个独立的PWM或GPIO口，而MC4通过复用器，允许你将同一个PWM信号灵活地路由到三个不同的物理引脚（PA1/PA3/PA5对应PWM A通道，PA2/PA4/PA6对应PWM B通道）。更重要的是，它有一个硬件互锁机制。你必须先写CTLB寄存器，再写CTLA寄存器，两个寄存器的值才会在同一个PWM周期结束时被同步更新到输出引脚。这个机制至关重要，它防止了在更新换相状态时，出现上下桥臂同时导通的“直通”危险状态，这种状态会瞬间烧毁MOSFET。硬件替你解决了这个时序难题，软件上就只需要关注逻辑，可靠性大大提升。

其次，它有一个16位定时器，支持输入捕捉功能。我们将三个霍尔传感器分别接到IRQ、TCAP1和TCAP2这三个引脚上，并设置为边沿触发中断。这样，转子每转过一个固定的电角度（例如60度），就会有一个传感器状态变化，触发一次输入捕捉中断。在中断服务程序里，我们读取定时器的值，两次捕捉值的时间差就对应了电机转过一定角度所需的时间，从而可以精确计算出电机的实时转速。这个方案比用软件轮询传感器状态要精准和高效得多。

最后，它还有一个8位ADC，我们用它来读取一个电位器的电压，作为用户设定的目标转速。整个系统的硬件框图非常清晰：MC4作为大脑，通过PA1-PA6这6个引脚输出控制信号给后级的驱动板（如KITITC122），驱动板进行电平转换和功率放大后，驱动三相无刷电机。电机的三个霍尔传感器信号直接反馈给MC4的IRQ、TCAP1和TCAP2引脚，形成一个完整的闭环。

2.2 功率驱动与接口电路设计要点

原方案使用了Motorola的KITITC122评估板作为驱动接口。这块板子的核心是一个由6个MOSFET构成的三相全桥逆变器。这里有几个硬件设计上的关键点，即使你使用其他驱动芯片或自行搭建电路，也需要特别注意：

1. 逻辑电平与死区时间：KITITC122的驱动逻辑是负逻辑，即输入0为开启，1为关闭。这在配置MC4的PWM控制寄存器时需要特别注意。更重要的是，任何半桥的上下管绝不能同时导通。除了依赖MC4的硬件互锁，驱动板本身通常也有硬件互锁或死区时间生成电路。如果自己设计驱动，必须在软件或硬件上确保存在一个微小的“死区”，即上管完全关闭后，延迟一小段时间再开启下管，反之亦然。
2. 电流采样与保护：成熟的驱动方案必须考虑过流保护。KITITC122板子提供了电流感应输出，可以接到MC4的ADC引脚。在软件中，可以在每次PWM周期开始时采样电流，如果超过阈值，立即关闭所有PWM输出。虽然原应用笔记未深入讨论，但在实际产品中，这是保证系统鲁棒性的必备功能。
3. 电源与滤波：电机是巨大的噪声源，特别是PWM开关瞬间会产生强烈的电压尖峰和电磁干扰。必须在电机电源入口处放置大容量电解电容和瓷片电容进行退耦。MCU的电源最好与电机驱动电源隔离，或使用磁珠、电感进行滤波，防止噪声耦合进MCU导致复位或程序跑飞。

注意：在连接霍尔传感器时，务必确认传感器的电源电压（通常是5V或与MCU逻辑电平兼容）和输出类型（开漏输出或推挽输出）。如果传感器是开漏输出，MCU的输入引脚需要启用内部上拉电阻或外接上拉电阻。

3. 无刷直流电机换相原理与软件实现

3.1 六步换相法与霍尔传感器解码

无刷直流电机最常用的驱动方式是六步换相法，也叫梯形波驱动。对于一个三相电机，在任意时刻，只有两相通电，另一相悬空。电流从一个相流入，从另一个相流出，产生一个推动转子旋转的磁场。

霍尔传感器通常有三个，在空间上间隔120度电角度安装。转子旋转时，每个传感器会根据面对的磁极（N或S）输出高或低电平。三个传感器的状态组合，每60度电角度变化一次，一个电周期（360度）内共有6个独特的组合，正好对应6个换相点。

以顺时针旋转为例，其换相顺序如下表所示（假设传感器输出：面对N极为1，S极为0；驱动逻辑：+15V表示上管开启，-15V表示下管开启，NC表示该相悬空）：

软件的任务就是实时读取这三个传感器的状态，根据当前状态查表，输出对应的驱动模式到三相桥。MC68HC705MC4的巧妙之处在于，我们可以将上表最后三列（Phase A, B, C）的驱动逻辑，预先计算好，存储为控制寄存器CTLA和CTLB的值。

3.2 基于中断的换相状态机实现

程序的核心是一个由霍尔传感器中断驱动的状态机。初始化完成后，主循环（MAIN）只做一件事：不断读取ADC（电位器）的值，更新目标转速REF。真正的换相工作全部在中断服务程序中完成。

当一个霍尔传感器引脚发生跳变（例如IRQ中断），程序进入中断服务例程。它首先清除中断标志，并切换该引脚下一次触发中断的边沿极性（从上升沿切到下降沿，或反之）。这是因为霍尔传感器输出的是方波，每个电周期内，每个传感器都会产生一次上升沿和一次下降沿，我们需要捕获每一次变化。

接着，程序读取三个传感器引脚（PA0, PB6, PB7）的状态，组合成一个3位的二进制数。这个数减去1后，范围是0-5，正好对应上表中的6个状态。然后，程序用这个值作为索引，跳转到一张“跳转表”（JMPTABF）中。跳转表的每个条目指向一个具体的换相子程序，如A_TO_B、A_TO_C等。

以A_TO_B（对应0度位置）为例，这个子程序主要做两件事：

1. 速度采样：读取16位定时器ACRH的值，存入变量FIRST。这个时间戳将在150度位置（C_TO_B子程序）再次被读取，两次的时间差就代表了电机转过150度电角度所需的时间，用于计算实际转速。
2. 执行换相：根据表1，在0度位置，需要开启A相上管和B相下管。对于KITITC122的负逻辑，这意味着PA2（A相上管）输出0，PA4（B相上管）输出1（关闭），PA6（C相上管）输出1（关闭）；同时，PA3（B相下管）输出PWM波，PA1和PA5输出1（关闭）。这些0/1/PWM的组合，被预先计算为两个常数，分别写入CTLB和CTLA寄存器。由于硬件互锁，只有两条指令都执行后，新的驱动模式才会生效。

整个换相过程非常高效。从进入中断到更新完驱动寄存器并返回，最少的只需要约100个指令周期（33微秒@3MHz总线）。这意味着电机可以达到很高的理论转速（计算值超过55000 RPM），瓶颈通常不在MCU，而在电机和驱动电路本身。

4. PID速度控制算法的深入剖析与实现

4.1 PID算法原理与离散化

开环控制下，给定一个固定的PWM占空比，电机空载时可能转得飞快，加上负载后转速就会下降。为了维持转速恒定，必须引入闭环反馈控制。PID是其中最经典、应用最广的算法。

PID是比例（Proportional）、积分（Integral）、微分（Derivative）的缩写。其连续时间的理想公式是： [ u(t) = K_p e(t) + K_i \int e(t)dt + K_d \frac{de(t)}{dt} ] 其中，( u(t) )是控制输出（这里就是PWM占空比），( e(t) )是误差（目标转速 - 实际转速）。

在单片机中，我们需要使用离散化的形式。假设控制周期为T，第k个周期的控制量计算如下：

1. 比例项 P：( P_k = K_p * e_k )。直接放大当前误差，反应最快，但单独使用会产生静差（稳态误差）或振荡。
2. 积分项 I：( I_k = I_{k-1} + K_i * e_k * T )。累积历史误差，专门用来消除静差。只要误差不为零，积分项就会不断累积，直到输出足够大的控制量将误差抵消。但积分太强会引起超调甚至震荡。
3. 微分项 D：( D_k = K_d * (e_k - e_{k-1}) / T )。预测误差未来的变化趋势。当误差有变大的苗头时，微分项就产生一个反向的控制作用，抑制变化，相当于增加了系统的阻尼，使响应更平稳。

离散PID的公式为： [ u_k = K_p e_k + K_i T \sum_{j=0}^{k} e_j + K_d \frac{(e_k - e_{k-1})}{T} ]

在原MC4的代码中，为了在8位机上高效运算，进行了一些简化和优化。

4.2 MC4汇编代码中的PID实现细节

程序在每个电周期执行两次PID算法（在150度和330度位置）。我们以代码中的PID子程序为例，拆解其计算过程：

1. 计算实际周期与误差：

   PID LDA ACRH ; 读取当前定时器值（第二次采样） STA SECOND SUB FIRST ; 减去第一次采样值，得到实际周期 PERIOD STA PERIOD SUB REF ; PERIOD - REF，得到原始误差，存入TMP STA TMP

   这里有一个关键点：周期越大，代表转速越慢。所以PERIOD - REF为正，表示实际转速比目标慢（误差为正）；为负则表示实际转速比目标快（误差为负）。REF值来自电位器ADC的采样值，经过缩放。

2. 计算微分项：

   SUB DELTA ; (本次误差 - 上次误差) -> 微分项 DIFF STA DIFF

   DELTA变量存储的是上一次的误差值。微分项近似为本次误差与上次误差的差值。

3. 计算积分项：

   ABS LDA TMP ; 取回本次误差 ADD DELTA ; 本次误差 + 上次误差 -> 积分项 INT (简化处理) STA INT

   注意，这里并不是标准的积分（累加和），而是一种简化：INT = e_k + e_{k-1}。标准的积分需要将每次误差累加，但这在8位机上容易溢出。这里用两次误差的和来近似，是一种工程上的简化，也能提供一定的积分消除静差效果。

4. 取绝对值与缩放： 由于后续计算需要正值，程序对误差DELTA、微分项DIFF和积分项INT都进行了取绝对值操作。然后，分别对这三项进行右移4位（除以16）的缩放。这是因为PID系数(K_p, K_i, K_d)都被隐含地设置为2的负幂次方（如1/16），乘法运算用右移就能完成，极大地节省了计算资源。

   S2 LSRA ; 对|DELTA|右移4位 LSRA LSRA LSRA STA TMP ; TMP = |DELTA| >> 4 (比例项分量) LDA DIFF ; 读取微分项 LSRA ; 右移4位 LSRA LSRA LSRA ; |DIFF| >> 4 ADD TMP ; 加上比例项分量 STA TMP ; TMP = (|DELTA|+|DIFF|) >> 4 LDA INT ; 读取积分项 LSRA ; 右移4位 LSRA LSRA LSRA ; |INT| >> 4 ADD TMP ; 加上前两项 STA TMP ; TMP = (|DELTA|+|DIFF|+|INT|) >> 4， 即PID输出量

   最终，TMP中存放的就是PID控制器的输出量，它是一个正值。

5. 应用输出，更新PWM：

   LDA PERIOD CMP REF ; 比较实际周期和目标周期 BCC FASTER ; 如果 PERIOD >= REF (实际转速 <= 目标)，跳转到FASTER SLOWER ; 否则 (实际转速 > 目标) LDA PWMAD ; 当前PWM占空比 SUB TMP ; 转速过快，减小PWM占空比 CMP #MIN ; 与最小占空比比较 BCC DONE ; 如果大于最小值，跳转DONE保存 LDA #MIN ; 否则，限制为最小值 BRA DONE FASTER LDA TMP ADD PWMAD ; 转速过慢，增加PWM占空比 BCC DONE ; 检查是否溢出（超过255） LDA #MAX ; 溢出则限制为最大值 DONE STA PWMAD ; 更新PWM占空比寄存器

   程序根据实际转速与目标转速的比较结果，决定是增加还是减少PWM占空比。增加或减少的幅度，就是前面计算出的PID输出量TMP。同时，程序还对PWM占空比进行了限幅，防止超出电机或驱动电路的安全范围。

实操心得：PID参数整定：原代码中的PID系数（通过右移位数体现）是通过“试凑法”确定的。在实际项目中，这是一个关键步骤。通常先设(K_i)和(K_d)为0，逐渐增大(K_p)直到系统出现临界振荡，然后取这个值的一半。接着加入积分项(K_i)，从小值开始增加，用于消除静差，但要注意积分饱和。最后加入微分项(K_d)来抑制超调和振荡。在电机控制中，由于机械惯性大，微分项往往可以设置得较小甚至为0（PI控制）。务必在真实负载下进行整定，空载和带载的系统特性差异很大。

5. 关键问题排查与系统优化经验

5.1 电机启动与堵转保护

无刷电机启动时，转子处于随机位置，如果直接施加一个换相序列，很可能因为磁场与转子位置不对齐而导致无法启动，电机只会抖动而不转，这就是启动失败。更严重的是，如果电机在运行中因为负载过大而突然停止，即发生“堵转”，持续的电流会迅速导致电机和驱动电路过热烧毁。

原代码中有一个优雅的堵转检测与启动辅助机制。它利用定时器溢出中断（TOF）。在正常旋转时，霍尔传感器会频繁触发输入捕捉中断，每次进入换相中断服务程序时，都会将“超时计数器”TIMEOUT清零。如果电机堵转，霍尔信号停止，那么输入捕捉中断也不再发生。这时，定时器溢出中断会周期性发生（例如每几毫秒一次）。在定时器溢出中断服务程序（TOFISR）中，程序会检查TIMEOUT计数器。如果连续发生3次溢出中断（即TIMEOUT >= 3），就判定为堵转。

一旦判定堵转，程序会执行“强拉启动”：每次溢出中断，就将PWM占空比增加16（ADD #$10），直到达到最大值$FF。这样，施加在线圈上的电压（电流）会逐渐增大，产生足够大的扭矩来尝试“挣脱”堵转状态。一旦电机开始转动，霍尔信号恢复，换相中断会立刻将TIMEOUT清零，系统重新回到正常的PID速度控制模式。

注意事项：这个“强拉”过程必须有时间或电流限制。原代码只是简单增加到最大占空比。在实际应用中，最好加入一个持续时间限制，比如持续“强拉”1秒后仍无法启动，则进入故障保护状态，关闭PWM输出并报警，防止因持续大电流损坏电机或MOSFET。

5.2 噪声抑制与软件抗干扰

电机驱动系统是一个强干扰环境。PWM开关会产生高频噪声，可能通过电源或空间耦合干扰MCU。除了之前提到的硬件滤波，软件上也需要采取措施：

1. 关键变量保护：对于在多处（主循环、中断）都会访问的全局变量，如目标速度REF、PWM占空比PWMAD，在8位机上虽然单条指令是原子的，但像“读取-修改-写回”这样的操作（例如ADD PWMAD）在中断中可能被打断，导致数据错误。在这个简单内核中，PID计算和PWM更新只在特定的换相点（150/330度）进行，与主循环更新REF是错开的，一定程度上避免了竞争。但在更复杂的系统中，可能需要暂时关闭中断来保护临界区。
2. 传感器去抖：霍尔传感器信号在跳变时可能会有毛刺。硬件上可以在传感器信号线上加一个小电容（如10nF）到地，进行低通滤波。软件上可以采用“多次采样取一致”的方法，或者在中断服务程序中，短暂延迟后再读取端口状态，避开毛刺。
3. 看门狗定时器：MC68HC705MC4内置看门狗。务必在初始化时启用它，并在主循环中定期喂狗。这是防止程序因强干扰跑飞的最后一道防线。

5.3 性能评估与扩展可能

根据原文档的分析，这个电机控制内核只消耗了298字节ROM和10字节RAM，CPU占用率在电机转速为10k RPM时约为8.5%，在5k RPM时仅为4.2%。这意味着MC4有大量的剩余资源。

我们可以利用这些资源进行功能扩展：

• 通信接口：利用MC4的SCI（串口）模块，实现与上位机的通信，接收速度指令、发送状态（电流、温度、故障码）等。
• 更高级的控制算法：例如，加入前馈控制来应对已知的负载扰动；或者实现基于磁场定向控制（FOC）的算法以获得更平滑的转矩和更高的效率，但这需要更强大的处理能力和电流采样。
• 多电机控制：如果电机转速不高，CPU负载低，甚至可以尝试用一颗MC4控制两个电机，通过分时复用的方式运行两套独立的状态机和PID算法。
• 状态监测与诊断：利用ADC定期采样电源电压、驱动板温度、电机相电流，实现过压、过温、过流的全面保护，并记录运行日志。

这个基于MC68HC705MC4的方案，虽然硬件平台已显陈旧，但其展现出的系统设计思想——利用专用硬件简化软件复杂度、采用高效的状态机与中断驱动、实现稳健的闭环控制与故障保护——对于任何嵌入式电机控制项目，都具有跨越时代的参考价值。当你理解了这些底层逻辑后，再迁移到更现代的ARM Cortex-M系列芯片上，利用其更强大的PWM定时器和硬件加速单元，你将能更加得心应手地设计出高性能、高可靠性的电机驱动系统。