基于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构成的三相全桥逆变器。这里有几个硬件设计上的关键点即使你使用其他驱动芯片或自行搭建电路也需要特别注意逻辑电平与死区时间KITITC122的驱动逻辑是负逻辑即输入0为开启1为关闭。这在配置MC4的PWM控制寄存器时需要特别注意。更重要的是任何半桥的上下管绝不能同时导通。除了依赖MC4的硬件互锁驱动板本身通常也有硬件互锁或死区时间生成电路。如果自己设计驱动必须在软件或硬件上确保存在一个微小的“死区”即上管完全关闭后延迟一小段时间再开启下管反之亦然。电流采样与保护成熟的驱动方案必须考虑过流保护。KITITC122板子提供了电流感应输出可以接到MC4的ADC引脚。在软件中可以在每次PWM周期开始时采样电流如果超过阈值立即关闭所有PWM输出。虽然原应用笔记未深入讨论但在实际产品中这是保证系统鲁棒性的必备功能。电源与滤波电机是巨大的噪声源特别是PWM开关瞬间会产生强烈的电压尖峰和电磁干扰。必须在电机电源入口处放置大容量电解电容和瓷片电容进行退耦。MCU的电源最好与电机驱动电源隔离或使用磁珠、电感进行滤波防止噪声耦合进MCU导致复位或程序跑飞。注意在连接霍尔传感器时务必确认传感器的电源电压通常是5V或与MCU逻辑电平兼容和输出类型开漏输出或推挽输出。如果传感器是开漏输出MCU的输入引脚需要启用内部上拉电阻或外接上拉电阻。3. 无刷直流电机换相原理与软件实现3.1 六步换相法与霍尔传感器解码无刷直流电机最常用的驱动方式是六步换相法也叫梯形波驱动。对于一个三相电机在任意时刻只有两相通电另一相悬空。电流从一个相流入从另一个相流出产生一个推动转子旋转的磁场。霍尔传感器通常有三个在空间上间隔120度电角度安装。转子旋转时每个传感器会根据面对的磁极N或S输出高或低电平。三个传感器的状态组合每60度电角度变化一次一个电周期360度内共有6个独特的组合正好对应6个换相点。以顺时针旋转为例其换相顺序如下表所示假设传感器输出面对N极为1S极为0驱动逻辑15V表示上管开启-15V表示下管开启NC表示该相悬空旋转角度 (度)传感器1 (Hall A)传感器2 (Hall B)传感器3 (Hall C)Phase APhase BPhase C通电绕组0 18010015V-15VNCA B-30 21011015VNC-15VA C-60 240010NC15V-15VB C-90 270011-15V15VNCB A-120 300001-15VNC15VC A-150 330101NC-15V15VC B-软件的任务就是实时读取这三个传感器的状态根据当前状态查表输出对应的驱动模式到三相桥。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度位置为例这个子程序主要做两件事速度采样读取16位定时器ACRH的值存入变量FIRST。这个时间戳将在150度位置C_TO_B子程序再次被读取两次的时间差就代表了电机转过150度电角度所需的时间用于计算实际转速。执行换相根据表1在0度位置需要开启A相上管和B相下管。对于KITITC122的负逻辑这意味着PA2A相上管输出0PA4B相上管输出1关闭PA6C相上管输出1关闭同时PA3B相下管输出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个周期的控制量计算如下比例项 P( P_k K_p * e_k )。直接放大当前误差反应最快但单独使用会产生静差稳态误差或振荡。积分项 I( I_k I_{k-1} K_i * e_k * T )。累积历史误差专门用来消除静差。只要误差不为零积分项就会不断累积直到输出足够大的控制量将误差抵消。但积分太强会引起超调甚至震荡。微分项 D( D_k K_d * (e_k - e_{k-1}) / T )。预测误差未来的变化趋势。当误差有变大的苗头时微分项就产生一个反向的控制作用抑制变化相当于增加了系统的阻尼使响应更平稳。离散PID的公式为 [ u_k K_p e_k K_i T \sum_{j0}^{k} e_j K_d \frac{(e_k - e_{k-1})}{T} ]在原MC4的代码中为了在8位机上高效运算进行了一些简化和优化。4.2 MC4汇编代码中的PID实现细节程序在每个电周期执行两次PID算法在150度和330度位置。我们以代码中的PID子程序为例拆解其计算过程计算实际周期与误差PID LDA ACRH ; 读取当前定时器值第二次采样 STA SECOND SUB FIRST ; 减去第一次采样值得到实际周期 PERIOD STA PERIOD SUB REF ; PERIOD - REF得到原始误差存入TMP STA TMP这里有一个关键点周期越大代表转速越慢。所以PERIOD - REF为正表示实际转速比目标慢误差为正为负则表示实际转速比目标快误差为负。REF值来自电位器ADC的采样值经过缩放。计算微分项SUB DELTA ; (本次误差 - 上次误差) - 微分项 DIFF STA DIFFDELTA变量存储的是上一次的误差值。微分项近似为本次误差与上次误差的差值。计算积分项ABS LDA TMP ; 取回本次误差 ADD DELTA ; 本次误差 上次误差 - 积分项 INT (简化处理) STA INT注意这里并不是标准的积分累加和而是一种简化INT e_k e_{k-1}。标准的积分需要将每次误差累加但这在8位机上容易溢出。这里用两次误差的和来近似是一种工程上的简化也能提供一定的积分消除静差效果。取绝对值与缩放 由于后续计算需要正值程序对误差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控制器的输出量它是一个正值。应用输出更新PWMLDA 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)来抑制超调和振荡。在电机控制中由于机械惯性大微分项往往可以设置得较小甚至为0PI控制。务必在真实负载下进行整定空载和带载的系统特性差异很大。5. 关键问题排查与系统优化经验5.1 电机启动与堵转保护无刷电机启动时转子处于随机位置如果直接施加一个换相序列很可能因为磁场与转子位置不对齐而导致无法启动电机只会抖动而不转这就是启动失败。更严重的是如果电机在运行中因为负载过大而突然停止即发生“堵转”持续的电流会迅速导致电机和驱动电路过热烧毁。原代码中有一个优雅的堵转检测与启动辅助机制。它利用定时器溢出中断TOF。在正常旋转时霍尔传感器会频繁触发输入捕捉中断每次进入换相中断服务程序时都会将“超时计数器”TIMEOUT清零。如果电机堵转霍尔信号停止那么输入捕捉中断也不再发生。这时定时器溢出中断会周期性发生例如每几毫秒一次。在定时器溢出中断服务程序TOFISR中程序会检查TIMEOUT计数器。如果连续发生3次溢出中断即TIMEOUT 3就判定为堵转。一旦判定堵转程序会执行“强拉启动”每次溢出中断就将PWM占空比增加16ADD #$10直到达到最大值$FF。这样施加在线圈上的电压电流会逐渐增大产生足够大的扭矩来尝试“挣脱”堵转状态。一旦电机开始转动霍尔信号恢复换相中断会立刻将TIMEOUT清零系统重新回到正常的PID速度控制模式。注意事项这个“强拉”过程必须有时间或电流限制。原代码只是简单增加到最大占空比。在实际应用中最好加入一个持续时间限制比如持续“强拉”1秒后仍无法启动则进入故障保护状态关闭PWM输出并报警防止因持续大电流损坏电机或MOSFET。5.2 噪声抑制与软件抗干扰电机驱动系统是一个强干扰环境。PWM开关会产生高频噪声可能通过电源或空间耦合干扰MCU。除了之前提到的硬件滤波软件上也需要采取措施关键变量保护对于在多处主循环、中断都会访问的全局变量如目标速度REF、PWM占空比PWMAD在8位机上虽然单条指令是原子的但像“读取-修改-写回”这样的操作例如ADD PWMAD在中断中可能被打断导致数据错误。在这个简单内核中PID计算和PWM更新只在特定的换相点150/330度进行与主循环更新REF是错开的一定程度上避免了竞争。但在更复杂的系统中可能需要暂时关闭中断来保护临界区。传感器去抖霍尔传感器信号在跳变时可能会有毛刺。硬件上可以在传感器信号线上加一个小电容如10nF到地进行低通滤波。软件上可以采用“多次采样取一致”的方法或者在中断服务程序中短暂延迟后再读取端口状态避开毛刺。看门狗定时器MC68HC705MC4内置看门狗。务必在初始化时启用它并在主循环中定期喂狗。这是防止程序因强干扰跑飞的最后一道防线。5.3 性能评估与扩展可能根据原文档的分析这个电机控制内核只消耗了298字节ROM和10字节RAMCPU占用率在电机转速为10k RPM时约为8.5%在5k RPM时仅为4.2%。这意味着MC4有大量的剩余资源。我们可以利用这些资源进行功能扩展通信接口利用MC4的SCI串口模块实现与上位机的通信接收速度指令、发送状态电流、温度、故障码等。更高级的控制算法例如加入前馈控制来应对已知的负载扰动或者实现基于磁场定向控制FOC的算法以获得更平滑的转矩和更高的效率但这需要更强大的处理能力和电流采样。多电机控制如果电机转速不高CPU负载低甚至可以尝试用一颗MC4控制两个电机通过分时复用的方式运行两套独立的状态机和PID算法。状态监测与诊断利用ADC定期采样电源电压、驱动板温度、电机相电流实现过压、过温、过流的全面保护并记录运行日志。这个基于MC68HC705MC4的方案虽然硬件平台已显陈旧但其展现出的系统设计思想——利用专用硬件简化软件复杂度、采用高效的状态机与中断驱动、实现稳健的闭环控制与故障保护——对于任何嵌入式电机控制项目都具有跨越时代的参考价值。当你理解了这些底层逻辑后再迁移到更现代的ARM Cortex-M系列芯片上利用其更强大的PWM定时器和硬件加速单元你将能更加得心应手地设计出高性能、高可靠性的电机驱动系统。