1. 先说这个项目到底在解决什么问题做51单片机直流电机调速的人多半都经历过这种尴尬旋钮拧到某个位置电机空载跑得挺欢手一捏阻力上来转速立刻掉一截供电电压从12V跌到9V转速也跟着缩水。占空比明明没有变实际转速却完全不受控制。这就是开环调速的典型症状。PID算法控制转速项目的核心价值就是把这堵墙拆掉——实时测出电机真实转速和设定转速做比较再用误差去修正PWM占空比让转速稳定收敛到目标值。下面我把这个项目从硬件选型、算法原理、C语言实现到参数整定踩坑记录完整写一遍给想在51上做闭环调速的朋友一条能直接复现的路。1.1 开环调速为什么调不住转速开环调速的逻辑很简单给电机一个固定占空比的PWM占空比越大平均电压越高转速越快。听起来直接但转速从来不是只由占空比决定的。负载、供电电压、电机温度、机械摩擦全都在无声地改变实际转速。拿常见的12V直流减速电机举例空载时占空比50%可能跑1200转挂上一个小阻力负载同一个占空比可能只剩900转。占空比没变转速却变了——因为系统根本不看输出只朝着一个方向喊话喊多大声和实际跑多快之间没有闭环校准。电池电压的影响更隐蔽。PWM占空比是一个比例概念50%占空比对应的是母线电压的一半母线电压本身跌了电机端的平均电压也跟着跌。锂电池放电到平台期之后电压明显下降电机转速自然往下掉。电压波动、负载波动、摩擦变化这三样凑在一起开环调速的转速误差能做到百分之二三十。有些场合无所谓但凡要求转速稳定的比如小型传送带、搅拌器、云台、定速绕线机全都忍不了。1.2 闭环控制其实就是把误差反复逼近零解决方案是闭环。在系统里加一个测速环节实时算出电机当前转速然后做减法误差 设定转速 - 实测转速。知道了误差再用一种策略把它压到最小这个策略就是PID算法。可以把它想成开车跑高速设定转速就是巡航目标你要看着仪表盘决定踩油门还是松油门。车速低了深踩车速高了收一收。PID做的正是这件事只不过它把踩油门的程度用数学公式量化了误差越大修正越大误差持续存在修正就持续积累误差变化越快越要提前收油防超调。51单片机在这个项目里的角色就是那个驾驶员。它不负责输出多漂亮的波形只负责在固定的时间节拍里循环执行测速、比较、修正三个动作。这也是为什么一颗51内核的芯片完全够用——控制决策本身的计算量很小真正的功夫在测速精度、控制周期和参数匹配上。2. 硬件选型与接线细节别让供电和测速拖后腿2.1 主控、电机、驱动、测速四件套怎么搭先说整体搭配我用的是一套非常常规的组合适合在常见学习板上直接扩展部件参考选型注意事项主控51内核的89C52系列开发板优先选带硬件PWMPCA的型号软件PWM会占用大量CPU电机12V直流减速电机带编码器编码器线数决定测速分辨率直接影响控制效果电机驱动L298N或TB6612模块驱动电源单独供逻辑电源与单片机共用5V测速霍尔编码器或光电编码器脉冲信号接到T0引脚P3.4用计数器模式硬件数脉冲主控没什么好纠结的89C52系列是目前学习板最常见的51内核器件IO资源、定时器数量都够。电机驱动方面L298N模块便宜皮实缺点是内部压降大发热明显TB6612模块是MOSFET结构压降小、效率高更省电接口也干净。我自己最后用的是TB6612因为项目是用电池供电的效率敏感如果你手头只有L298N也能做注意给模块留出散热空间就行。2.2 测速分辨率13脉冲和1080线编码器的差距有多大这是整个项目最容易低估的一环。很多便宜的减速电机自带一块小磁钢加霍尔元件输出轴每转一圈给13个脉冲。这种电机拿来转着玩没问题但做PID调速就尴尬了。先算一笔账。测速窗口取20ms电机1000转/分钟时13脉冲/圈的编码器每秒产生约217个脉冲20ms内只能数到4到5个。换算成转速每个脉冲代表约230转/分钟的跳变——也就是说速度反馈在1000转上下以230转的台阶跳来跳去。PID看到的是一个量化噪声极大的反馈值比例项和微分项都会跟着剧烈抖动占空比被带得忽大忽小转速根本稳不住。想让这种低分辨率编码器勉强可用只能把测速窗口拉长到200ms甚至更长让一个窗口内能数到40多脉冲分辨率降到20多转。代价是控制周期变慢系统响应迟钝负载突变后要很久才恢复。这不是参数能救的是反馈通路的天花板。所以我最终选了一款带光电编码器的减速电机每圈输出1080个脉冲。同样20ms窗口、1000转/分钟时一个窗口能数到约360个脉冲每个脉冲对应约2.8转/分钟的转速分辨率。这个精度对PID来说就非常舒服了。选硬件时记住一句话测速分辨率决定控制上限编码器太差后面算法写得再好也白搭。2.3 共地与供电这个项目八成故障都出在这里接线看起来简单翻车点却非常集中。第一是共地。电机的驱动电源12V和单片机逻辑电源5V的参考地必须连在一起编码器信号才有统一的电平参考。不共地的话测速脉冲信号会在0和1之间随机漂移转速反馈乱跳PID输出跟着疯狂摆动现象就像电机抽风。第二是别用USB口或开发板5V直接驱动电机。电机启动瞬间电流可能到一两安甚至更高USB口直接进入保护开发板上的稳压芯片也会过热。正确做法是驱动模块的VM接12V电源VCC接5V可从板子取两路电源共地。供电纹波也不能忽略。电机是感性负载换向瞬间会产生尖峰建议在驱动板电源输入端并一只470μF到1000μF的电解电容再加一只104瓷片电容吸收高频。编码器的信号线尽量和PWM输出线、电机线分开走避免干扰串进测速通路。3. PID算法在51上的落地从公式到C语言3.1 先用大白话理解PID公式PID三个字母对应三项输出P是比例项误差多大就修正多大误差为零就停止修正I是积分项把历史上所有误差累加起来专门对付有误差但P项修正不动的静差D是微分项看误差的变化趋势误差快速增大时提前反向压制抑制超调。位置式PID公式长这样u(k) Kp × e(k) Ki × Σe(j) Kd × [e(k) - e(k-1)]其中e(k)是本次误差e(k-1)是上次误差Σe(j)是误差累加。u(k)最终映射到PWM占空比。对51来说这个公式全是整数乘法和加减法写着不复杂真正的坑在后面那些工程处理上。3.2 控制节拍怎么定20ms采样周期为什么合适控制系统是周期性运行的每隔固定时间测一次速、算一次PID、更新一次占空比。这个周期叫采样周期Ts。电机是惯性环节机械响应时间通常在几十毫秒量级采样周期选10ms到50ms都能工作。我选了20ms理由很朴素第一20ms在11.0592MHz晶振、12T模式下正好对应18432个机器周期定时器装载值可以是整的误差为零第二220ms的周期给51留足了时间去做串口发送、按键扫描这类杂事第三配合1080线编码器20ms窗口内能数到足够多的脉冲测速分辨率足够。采样周期一旦确定后面所有PID参数都依赖这个时间基准。换周期就等于换一套参数这是新手最容易忽略的。3.3 定时器资源分配计数、测速、PWM三件事不打架89C52的资源很有限但刚好够这个项目用。我的分配方案是T0P3.4配置成计数器模式专门数编码器A相脉冲。硬件计数不占CPU时间只有溢出才中断。1080线编码器在3000转/分钟内都不可能在一个采样窗口里数到65536个脉冲所以根本不用管溢出。T1配置成定时器模式产生20ms定时中断承担采样算PID更新占空比三件事。PWM优先用PCA硬件PWM模块占空比更新只需要改一个寄存器不消耗CPU。不同的51内核芯片硬件PWM寄存器命名有差异具体以你手头的头文件和手册为准。如果主控没有硬件PWM只能拿定时器做软件PWM我后面会单独说它的局限性。初始化代码大致长这样// T0: 16位计数器模式; T1: 16位定时器模式 TMOD 0x15; // T1: 11.0592MHz, 12T模式, 20ms 18432个机器周期 TH1 0xB8; TL1 0x00; ET1 1; TR1 1; // T0: 计数模式, 从0开始 TH0 0; TL0 0; TR0 1; // 打开总中断 EA 1;这里面唯一要注意的是TR0的用法。计数过程中TR0始终是1读取计数值之前先把它清零防止读数的瞬间T0还在变化读完再恢复。这就是典型的先停表、再读表、再走表操作。3.4 测速换算和PID核心代码拆解脉冲数换算转速的公式可以写成这样转速(RPM) 脉冲数 × 60 / (每转脉冲数 × 采样周期秒数)。代入20ms和1080线编码器就是RPM 脉冲数 × 60 / (1080 × 0.02) 脉冲数 × 3000 / 1080也就是每个脉冲大约2.8转。代码里我统一用整数运算先转成long型再除避免中间溢出。下面是T1中断里的完整处理逻辑#define PWM_FULL 1000 // 占空比满刻度千分比方便调参 int set_rpm 1000; // 设定转速可由按键或串口修改 int act_rpm; // 实测转速 int pwm_duty; // 输出占空比 0~1000 long err_sum; // 积分累加 int err_now, err_last; // 本次、上次误差 // PID参数Ts 20ms int Kp 12; int Ki 3; int Kd 8; // 三点滑动平均用的缓存 int speed_buf[3]; void timer1_isr(void) interrupt 3 { unsigned int cnt; long pid_out; // 1. 读T0计数值清零后重新计数 TR0 0; cnt (unsigned int)((TH0 8) | TL0); TH0 0; TL0 0; TR0 1; // 2. 脉冲数换算成转速 act_rpm (int)(((long)cnt * 3000L) / 1080L); // 3. 三点滑动平均滤波压掉量化台阶 speed_buf[2] speed_buf[1]; speed_buf[1] speed_buf[0]; speed_buf[0] act_rpm; act_rpm (speed_buf[0] speed_buf[1] speed_buf[2]) / 3; // 4. 计算误差 err_now set_rpm - act_rpm; // 5. 积分分离误差太大时不积分防止启动瞬间积分饱和 if (err_now -300 err_now 300) { err_sum err_now; if (err_sum 800) err_sum 800; // 积分限幅 if (err_sum -800) err_sum -800; } else { err_sum 0; } // 死区误差在正负3转以内清积分避免占空比抖动 if (err_now -3 err_now 3) { err_sum 0; } // 6. PID计算用long型防止中间结果溢出 pid_out (long)Kp * err_now (long)Ki * err_sum (long)Kd * (err_now - err_last); err_last err_now; // 7. 输出限幅 if (pid_out PWM_FULL) pid_out PWM_FULL; if (pid_out 0) pid_out 0; pwm_duty (int)pid_out; }中断里的顺序是有讲究的。先读计数、再换算、再滤波、最后算PID。换算和滤波放前面是因为任何一步占了太多时间都会影响下一次计数精度。PID计算本身放在最后就算多个十几微秒影响的也只是本次输出更新的时间点不会丢失脉冲计数。3.5 输出限幅、积分限幅、死区为什么一个都不能少这三个东西看着像补丁实际上缺一个系统就要崩。输出限幅好理解占空比不能超过100%也不能为负——本项目的调速只要求正转负占空比没有意义。不加限幅一旦计算结果超界赋值给硬件PWM寄存器时会发生截断或翻转波形完全错乱。积分限幅是防积分饱和的保险。电机刚上电时设定1000转、实际0转误差巨大积分如果照常累加几秒钟就能攒出一个天文数字。等电机真正跑起来这个巨大的积分项还要慢慢吐回来表现为转速冲到设定值一大截才回落甚至来回震荡。所以我做了积分分离误差超过300转直接清积分系统启动时以纯比例和微分控制为主。死区处理则是为了让稳态更安静。误差在正负3转以内时转速差已经小于一个编码器脉冲对应的分辨率这时候继续微调占空比没有任何意义只会让PWM输出在某个值附近抖动电机发出滋滋声。清掉积分、固定占空比系统反而更稳。占空比换算到硬件PWM寄存器这一步我放在主循环里做格式大概是// 把千分比占空比映射到硬件PWM的8位比较值 // 具体换算方向和寄存器名以数据手册为准 pwm_reg (unsigned char)((unsigned long)pwm_duty * 255UL / 1000UL);3.6 没有硬件PWM的51怎么办如果你的51内核芯片没有PCA或CCP模块只能做软件PWM。软件PWM的痛点是频率和档位不可兼得。想达到1kHz的PWM频率再加100个占空比档位定时器中断就得每10微秒一次51根本扛不住。实际能做的往往是1kHz频率配10到20个档位占空比比较粗糙电机在低速区会有可闻噪声和转矩脉动。我的建议很直接要么换一颗带硬件PWM的51内核芯片要么老老实实在驱动端外接一个555电路或专门的PWM芯片。把宝贵的定时器中断留着做PID比什么都重要。4. 参数整定实录我把P、I、D一个个加回去4.1 只加P项从迟钝到等幅震荡整定参数没有任何捷径至少第一次没有。我把Ki和Kd先关掉从Kp2开始每次改完参数后跑一次1000转的阶跃启动。Kp2时的表现电机慢慢悠悠爬升大概1秒出头才到设定值附近不超调但太肉。Kp10时上升明显变快过冲大约100转两三个衰减震荡之后能收敛。Kp15继续加快过冲更大。到Kp20时转速开始围绕目标值等幅震荡幅度大约正负80转电机发出明显的嗡鸣声——这就是临界振荡状态。记录下这个临界点很有用。临界增益Ku约20临界振荡周期Tu约0.2秒。按经典的经验公式PI控制器推荐值大概是Kp等于0.6倍Ku也就是12左右积分时间取0.5倍Tu算下来Ki的推荐值在2.4附近。这个计算不用照搬但能给你一个靠谱的起点。4.2 加积分项消静差但积分饱和更可怕只靠P项时我发现一个现象电机空载冲到设定值附近后最终转速比设定低了一截。比如设定1000转稳定在950转就不动了。这是因为P项在误差为零时输出为零而在有摩擦阻力的系统里需要持续输出一个占空比才能维持转速。这个持续输出只能靠积分项提供。所以我从Ki2开始加。效果立竿见影误差慢慢被抹平最终能稳定在设定值附近。但Ki加大到5之后出问题了启动瞬间电机比之前凶得多转速一口气冲到1400多转才回头然后来回甩了两三次才稳定。这就是典型的积分饱和。我的处理正是前面代码里那套组合拳误差大于300转时清积分、积分累加值限幅在正负800、死区范围内清积分。4.3 微分项加还是不加先滤波再上D到这一步系统用P加I已经能工作静态精度也达标剩下的主要问题是过冲。想进一步压超调就得靠微分项。但D项对噪声极端敏感编码器测速有量化台阶滤波之前速度估计每次跳几个转误差的差分会被噪声放大表现为占空比高频抖动。我的做法是先加三点滑动平均滤波把速度反馈磨平再上Kd。滤波会给系统带来额外延迟所以Kd也不要一下给太大。我从Kd5开始试超调从约10%降到6%再提到8超调收到5%以内动态过程变得干脆。继续加大到12系统又开始轻微抖动——到了这个点再往加就没意义了。4.4 我最后用的一组参数和整定顺序最终定下来的参数如下采样周期固定20ms参数数值说明Kp12每1转误差对应1.2%占空比修正Ki3消除静差兼顾恢复速度Kd8配合滤波压制超调积分限幅正负800防积分饱和误差分离阈值300转误差过大时禁积分死区正负3转避免稳态占空比抖动整定的顺序口诀是先P后I再D每次只动一个参数。P从0加到临界震荡取临界增益的一半到六成当初值I从很小往上加盯着静差和超调的平衡D去解决震荡和过冲但必须先滤波再上手。每次改完参数只跑一次阶跃拿笔记录超调量、调节时间、稳态误差三个数比盯着波形瞎猜强得多。5. 实测结果与调试怎么验证转速是真的稳了5.1 串口把曲线发出来让数据说话调试闭环系统最忌讳凭手感。我给系统加了串口输出每个控制周期发一行数据格式类似S1000,A998,P520S是设定转速A是实测转速P是当前占空比。电脑上随便一个串口助手就能看也可以把数据导进表格软件里画曲线。曲线能告诉你很多细节。比如实测转速在稳态时如果有规律的锯齿状波动大概率是测速量化台阶太大需要更细的编码器或更长的测速窗口如果PWM占空比在高频抖动多半是D项被噪声带着跑先把滤波加上如果曲线呈等幅正弦状那是参数还压在临界点上。数据一画出来问题定位比听声音靠谱一百倍。串口初始化和发送代码不复杂注意用11.0592MHz晶振配9600波特率时定时器初值误差为零这是最标准的组合。5.2 两类关键测试阶跃响应和负载扰动参数定完得跑两个标准测试才算真正验证。第一个是阶跃测试设定转速从600转直接跳到1200转看转速曲线的上升时间、超调量和调节时间。我最终这组参数的表现是上升时间约0.35秒超调在5%以内大约0.6秒内进入正负5转的稳态带。这个表现对一般小型设备完全够用。第二个是负载扰动测试电机稳定在1000转时用手轻捏电机轴模拟负载突变。注意不要完全捏死防止电流过大。捏住瞬间转速掉了大约80转松开后约0.5秒内恢复回1000转。恢复速度靠P项能不能回得到设定值靠I项——如果捏住后转速拉不回去说明Ki偏小或者积分限幅卡得太死。还可以做一次供电扰动把12V电源换成9V试一次。转速如果还能稳定在设定值说明闭环对母线电压波动有真正的抑制作用这也是开环系统做不到的。5.3 常见故障排查表整理一下我踩过和见过的坑方便你对照排查现象可能原因处理方式电机完全不转驱动使能脚没拉高、PWM脚接错、电源功率不足检查IN/EN引脚电平用示波器或逻辑分析仪看PWM波形转速疯狂乱跳单片机与驱动电源未共地、编码器线受干扰确认共地编码器线绞合或做RC滤波必要时加上拉电阻设定1000转只能跑到800P太小或I项没起作用适当加大Kp检查积分限幅是否太紧启动瞬间猛冲一下积分饱和加积分分离、积分限幅、输出限幅稳态等幅震荡Kp偏大、缺D项、滤波不足降Kp、提高滤波强度、谨慎加Kd占空比波形毛刺多逻辑电源纹波大加强电源滤波电容编码器线远离PWM线电机有明显高频噪声PWM频率偏低调高硬件PWM时钟分频或改用带硬件PWM的芯片调试时还有一条经验每次只改一个参数改完必须重新上电跑一次完整测试。连续改三个参数再一起测试出了问题根本不知道是哪一个的锅。最后说一点个人体会。这个项目做完之后我最深的感触是PID本身不难公式背下来五分钟代码抄一遍十分钟真正决定成败的是三件事测速分辨率够不够、控制周期和反馈量化匹不匹配、积分饱和这类工程细节有没有处理到位。很多系统调不稳不是算法不行是反馈通路的精度配不上算法的胃口。另外如果你还没买电机我强烈建议直接选带光电编码器的高分辨率型号别在13脉冲的霍尔电机上省钱——省下的钱最后都会变成调试时的头发。先把这一套跑通后面不管是改成按键调速、加数码管显示还是换串口下发目标转速都只是在这个骨架上添砖加瓦的事。
1. 先说这个项目到底在解决什么问题做51单片机直流电机调速的人多半都经历过这种尴尬旋钮拧到某个位置电机空载跑得挺欢手一捏阻力上来转速立刻掉一截供电电压从12V跌到9V转速也跟着缩水。占空比明明没有变实际转速却完全不受控制。这就是开环调速的典型症状。PID算法控制转速项目的核心价值就是把这堵墙拆掉——实时测出电机真实转速和设定转速做比较再用误差去修正PWM占空比让转速稳定收敛到目标值。下面我把这个项目从硬件选型、算法原理、C语言实现到参数整定踩坑记录完整写一遍给想在51上做闭环调速的朋友一条能直接复现的路。1.1 开环调速为什么调不住转速开环调速的逻辑很简单给电机一个固定占空比的PWM占空比越大平均电压越高转速越快。听起来直接但转速从来不是只由占空比决定的。负载、供电电压、电机温度、机械摩擦全都在无声地改变实际转速。拿常见的12V直流减速电机举例空载时占空比50%可能跑1200转挂上一个小阻力负载同一个占空比可能只剩900转。占空比没变转速却变了——因为系统根本不看输出只朝着一个方向喊话喊多大声和实际跑多快之间没有闭环校准。电池电压的影响更隐蔽。PWM占空比是一个比例概念50%占空比对应的是母线电压的一半母线电压本身跌了电机端的平均电压也跟着跌。锂电池放电到平台期之后电压明显下降电机转速自然往下掉。电压波动、负载波动、摩擦变化这三样凑在一起开环调速的转速误差能做到百分之二三十。有些场合无所谓但凡要求转速稳定的比如小型传送带、搅拌器、云台、定速绕线机全都忍不了。1.2 闭环控制其实就是把误差反复逼近零解决方案是闭环。在系统里加一个测速环节实时算出电机当前转速然后做减法误差 设定转速 - 实测转速。知道了误差再用一种策略把它压到最小这个策略就是PID算法。可以把它想成开车跑高速设定转速就是巡航目标你要看着仪表盘决定踩油门还是松油门。车速低了深踩车速高了收一收。PID做的正是这件事只不过它把踩油门的程度用数学公式量化了误差越大修正越大误差持续存在修正就持续积累误差变化越快越要提前收油防超调。51单片机在这个项目里的角色就是那个驾驶员。它不负责输出多漂亮的波形只负责在固定的时间节拍里循环执行测速、比较、修正三个动作。这也是为什么一颗51内核的芯片完全够用——控制决策本身的计算量很小真正的功夫在测速精度、控制周期和参数匹配上。2. 硬件选型与接线细节别让供电和测速拖后腿2.1 主控、电机、驱动、测速四件套怎么搭先说整体搭配我用的是一套非常常规的组合适合在常见学习板上直接扩展部件参考选型注意事项主控51内核的89C52系列开发板优先选带硬件PWMPCA的型号软件PWM会占用大量CPU电机12V直流减速电机带编码器编码器线数决定测速分辨率直接影响控制效果电机驱动L298N或TB6612模块驱动电源单独供逻辑电源与单片机共用5V测速霍尔编码器或光电编码器脉冲信号接到T0引脚P3.4用计数器模式硬件数脉冲主控没什么好纠结的89C52系列是目前学习板最常见的51内核器件IO资源、定时器数量都够。电机驱动方面L298N模块便宜皮实缺点是内部压降大发热明显TB6612模块是MOSFET结构压降小、效率高更省电接口也干净。我自己最后用的是TB6612因为项目是用电池供电的效率敏感如果你手头只有L298N也能做注意给模块留出散热空间就行。2.2 测速分辨率13脉冲和1080线编码器的差距有多大这是整个项目最容易低估的一环。很多便宜的减速电机自带一块小磁钢加霍尔元件输出轴每转一圈给13个脉冲。这种电机拿来转着玩没问题但做PID调速就尴尬了。先算一笔账。测速窗口取20ms电机1000转/分钟时13脉冲/圈的编码器每秒产生约217个脉冲20ms内只能数到4到5个。换算成转速每个脉冲代表约230转/分钟的跳变——也就是说速度反馈在1000转上下以230转的台阶跳来跳去。PID看到的是一个量化噪声极大的反馈值比例项和微分项都会跟着剧烈抖动占空比被带得忽大忽小转速根本稳不住。想让这种低分辨率编码器勉强可用只能把测速窗口拉长到200ms甚至更长让一个窗口内能数到40多脉冲分辨率降到20多转。代价是控制周期变慢系统响应迟钝负载突变后要很久才恢复。这不是参数能救的是反馈通路的天花板。所以我最终选了一款带光电编码器的减速电机每圈输出1080个脉冲。同样20ms窗口、1000转/分钟时一个窗口能数到约360个脉冲每个脉冲对应约2.8转/分钟的转速分辨率。这个精度对PID来说就非常舒服了。选硬件时记住一句话测速分辨率决定控制上限编码器太差后面算法写得再好也白搭。2.3 共地与供电这个项目八成故障都出在这里接线看起来简单翻车点却非常集中。第一是共地。电机的驱动电源12V和单片机逻辑电源5V的参考地必须连在一起编码器信号才有统一的电平参考。不共地的话测速脉冲信号会在0和1之间随机漂移转速反馈乱跳PID输出跟着疯狂摆动现象就像电机抽风。第二是别用USB口或开发板5V直接驱动电机。电机启动瞬间电流可能到一两安甚至更高USB口直接进入保护开发板上的稳压芯片也会过热。正确做法是驱动模块的VM接12V电源VCC接5V可从板子取两路电源共地。供电纹波也不能忽略。电机是感性负载换向瞬间会产生尖峰建议在驱动板电源输入端并一只470μF到1000μF的电解电容再加一只104瓷片电容吸收高频。编码器的信号线尽量和PWM输出线、电机线分开走避免干扰串进测速通路。3. PID算法在51上的落地从公式到C语言3.1 先用大白话理解PID公式PID三个字母对应三项输出P是比例项误差多大就修正多大误差为零就停止修正I是积分项把历史上所有误差累加起来专门对付有误差但P项修正不动的静差D是微分项看误差的变化趋势误差快速增大时提前反向压制抑制超调。位置式PID公式长这样u(k) Kp × e(k) Ki × Σe(j) Kd × [e(k) - e(k-1)]其中e(k)是本次误差e(k-1)是上次误差Σe(j)是误差累加。u(k)最终映射到PWM占空比。对51来说这个公式全是整数乘法和加减法写着不复杂真正的坑在后面那些工程处理上。3.2 控制节拍怎么定20ms采样周期为什么合适控制系统是周期性运行的每隔固定时间测一次速、算一次PID、更新一次占空比。这个周期叫采样周期Ts。电机是惯性环节机械响应时间通常在几十毫秒量级采样周期选10ms到50ms都能工作。我选了20ms理由很朴素第一20ms在11.0592MHz晶振、12T模式下正好对应18432个机器周期定时器装载值可以是整的误差为零第二220ms的周期给51留足了时间去做串口发送、按键扫描这类杂事第三配合1080线编码器20ms窗口内能数到足够多的脉冲测速分辨率足够。采样周期一旦确定后面所有PID参数都依赖这个时间基准。换周期就等于换一套参数这是新手最容易忽略的。3.3 定时器资源分配计数、测速、PWM三件事不打架89C52的资源很有限但刚好够这个项目用。我的分配方案是T0P3.4配置成计数器模式专门数编码器A相脉冲。硬件计数不占CPU时间只有溢出才中断。1080线编码器在3000转/分钟内都不可能在一个采样窗口里数到65536个脉冲所以根本不用管溢出。T1配置成定时器模式产生20ms定时中断承担采样算PID更新占空比三件事。PWM优先用PCA硬件PWM模块占空比更新只需要改一个寄存器不消耗CPU。不同的51内核芯片硬件PWM寄存器命名有差异具体以你手头的头文件和手册为准。如果主控没有硬件PWM只能拿定时器做软件PWM我后面会单独说它的局限性。初始化代码大致长这样// T0: 16位计数器模式; T1: 16位定时器模式 TMOD 0x15; // T1: 11.0592MHz, 12T模式, 20ms 18432个机器周期 TH1 0xB8; TL1 0x00; ET1 1; TR1 1; // T0: 计数模式, 从0开始 TH0 0; TL0 0; TR0 1; // 打开总中断 EA 1;这里面唯一要注意的是TR0的用法。计数过程中TR0始终是1读取计数值之前先把它清零防止读数的瞬间T0还在变化读完再恢复。这就是典型的先停表、再读表、再走表操作。3.4 测速换算和PID核心代码拆解脉冲数换算转速的公式可以写成这样转速(RPM) 脉冲数 × 60 / (每转脉冲数 × 采样周期秒数)。代入20ms和1080线编码器就是RPM 脉冲数 × 60 / (1080 × 0.02) 脉冲数 × 3000 / 1080也就是每个脉冲大约2.8转。代码里我统一用整数运算先转成long型再除避免中间溢出。下面是T1中断里的完整处理逻辑#define PWM_FULL 1000 // 占空比满刻度千分比方便调参 int set_rpm 1000; // 设定转速可由按键或串口修改 int act_rpm; // 实测转速 int pwm_duty; // 输出占空比 0~1000 long err_sum; // 积分累加 int err_now, err_last; // 本次、上次误差 // PID参数Ts 20ms int Kp 12; int Ki 3; int Kd 8; // 三点滑动平均用的缓存 int speed_buf[3]; void timer1_isr(void) interrupt 3 { unsigned int cnt; long pid_out; // 1. 读T0计数值清零后重新计数 TR0 0; cnt (unsigned int)((TH0 8) | TL0); TH0 0; TL0 0; TR0 1; // 2. 脉冲数换算成转速 act_rpm (int)(((long)cnt * 3000L) / 1080L); // 3. 三点滑动平均滤波压掉量化台阶 speed_buf[2] speed_buf[1]; speed_buf[1] speed_buf[0]; speed_buf[0] act_rpm; act_rpm (speed_buf[0] speed_buf[1] speed_buf[2]) / 3; // 4. 计算误差 err_now set_rpm - act_rpm; // 5. 积分分离误差太大时不积分防止启动瞬间积分饱和 if (err_now -300 err_now 300) { err_sum err_now; if (err_sum 800) err_sum 800; // 积分限幅 if (err_sum -800) err_sum -800; } else { err_sum 0; } // 死区误差在正负3转以内清积分避免占空比抖动 if (err_now -3 err_now 3) { err_sum 0; } // 6. PID计算用long型防止中间结果溢出 pid_out (long)Kp * err_now (long)Ki * err_sum (long)Kd * (err_now - err_last); err_last err_now; // 7. 输出限幅 if (pid_out PWM_FULL) pid_out PWM_FULL; if (pid_out 0) pid_out 0; pwm_duty (int)pid_out; }中断里的顺序是有讲究的。先读计数、再换算、再滤波、最后算PID。换算和滤波放前面是因为任何一步占了太多时间都会影响下一次计数精度。PID计算本身放在最后就算多个十几微秒影响的也只是本次输出更新的时间点不会丢失脉冲计数。3.5 输出限幅、积分限幅、死区为什么一个都不能少这三个东西看着像补丁实际上缺一个系统就要崩。输出限幅好理解占空比不能超过100%也不能为负——本项目的调速只要求正转负占空比没有意义。不加限幅一旦计算结果超界赋值给硬件PWM寄存器时会发生截断或翻转波形完全错乱。积分限幅是防积分饱和的保险。电机刚上电时设定1000转、实际0转误差巨大积分如果照常累加几秒钟就能攒出一个天文数字。等电机真正跑起来这个巨大的积分项还要慢慢吐回来表现为转速冲到设定值一大截才回落甚至来回震荡。所以我做了积分分离误差超过300转直接清积分系统启动时以纯比例和微分控制为主。死区处理则是为了让稳态更安静。误差在正负3转以内时转速差已经小于一个编码器脉冲对应的分辨率这时候继续微调占空比没有任何意义只会让PWM输出在某个值附近抖动电机发出滋滋声。清掉积分、固定占空比系统反而更稳。占空比换算到硬件PWM寄存器这一步我放在主循环里做格式大概是// 把千分比占空比映射到硬件PWM的8位比较值 // 具体换算方向和寄存器名以数据手册为准 pwm_reg (unsigned char)((unsigned long)pwm_duty * 255UL / 1000UL);3.6 没有硬件PWM的51怎么办如果你的51内核芯片没有PCA或CCP模块只能做软件PWM。软件PWM的痛点是频率和档位不可兼得。想达到1kHz的PWM频率再加100个占空比档位定时器中断就得每10微秒一次51根本扛不住。实际能做的往往是1kHz频率配10到20个档位占空比比较粗糙电机在低速区会有可闻噪声和转矩脉动。我的建议很直接要么换一颗带硬件PWM的51内核芯片要么老老实实在驱动端外接一个555电路或专门的PWM芯片。把宝贵的定时器中断留着做PID比什么都重要。4. 参数整定实录我把P、I、D一个个加回去4.1 只加P项从迟钝到等幅震荡整定参数没有任何捷径至少第一次没有。我把Ki和Kd先关掉从Kp2开始每次改完参数后跑一次1000转的阶跃启动。Kp2时的表现电机慢慢悠悠爬升大概1秒出头才到设定值附近不超调但太肉。Kp10时上升明显变快过冲大约100转两三个衰减震荡之后能收敛。Kp15继续加快过冲更大。到Kp20时转速开始围绕目标值等幅震荡幅度大约正负80转电机发出明显的嗡鸣声——这就是临界振荡状态。记录下这个临界点很有用。临界增益Ku约20临界振荡周期Tu约0.2秒。按经典的经验公式PI控制器推荐值大概是Kp等于0.6倍Ku也就是12左右积分时间取0.5倍Tu算下来Ki的推荐值在2.4附近。这个计算不用照搬但能给你一个靠谱的起点。4.2 加积分项消静差但积分饱和更可怕只靠P项时我发现一个现象电机空载冲到设定值附近后最终转速比设定低了一截。比如设定1000转稳定在950转就不动了。这是因为P项在误差为零时输出为零而在有摩擦阻力的系统里需要持续输出一个占空比才能维持转速。这个持续输出只能靠积分项提供。所以我从Ki2开始加。效果立竿见影误差慢慢被抹平最终能稳定在设定值附近。但Ki加大到5之后出问题了启动瞬间电机比之前凶得多转速一口气冲到1400多转才回头然后来回甩了两三次才稳定。这就是典型的积分饱和。我的处理正是前面代码里那套组合拳误差大于300转时清积分、积分累加值限幅在正负800、死区范围内清积分。4.3 微分项加还是不加先滤波再上D到这一步系统用P加I已经能工作静态精度也达标剩下的主要问题是过冲。想进一步压超调就得靠微分项。但D项对噪声极端敏感编码器测速有量化台阶滤波之前速度估计每次跳几个转误差的差分会被噪声放大表现为占空比高频抖动。我的做法是先加三点滑动平均滤波把速度反馈磨平再上Kd。滤波会给系统带来额外延迟所以Kd也不要一下给太大。我从Kd5开始试超调从约10%降到6%再提到8超调收到5%以内动态过程变得干脆。继续加大到12系统又开始轻微抖动——到了这个点再往加就没意义了。4.4 我最后用的一组参数和整定顺序最终定下来的参数如下采样周期固定20ms参数数值说明Kp12每1转误差对应1.2%占空比修正Ki3消除静差兼顾恢复速度Kd8配合滤波压制超调积分限幅正负800防积分饱和误差分离阈值300转误差过大时禁积分死区正负3转避免稳态占空比抖动整定的顺序口诀是先P后I再D每次只动一个参数。P从0加到临界震荡取临界增益的一半到六成当初值I从很小往上加盯着静差和超调的平衡D去解决震荡和过冲但必须先滤波再上手。每次改完参数只跑一次阶跃拿笔记录超调量、调节时间、稳态误差三个数比盯着波形瞎猜强得多。5. 实测结果与调试怎么验证转速是真的稳了5.1 串口把曲线发出来让数据说话调试闭环系统最忌讳凭手感。我给系统加了串口输出每个控制周期发一行数据格式类似S1000,A998,P520S是设定转速A是实测转速P是当前占空比。电脑上随便一个串口助手就能看也可以把数据导进表格软件里画曲线。曲线能告诉你很多细节。比如实测转速在稳态时如果有规律的锯齿状波动大概率是测速量化台阶太大需要更细的编码器或更长的测速窗口如果PWM占空比在高频抖动多半是D项被噪声带着跑先把滤波加上如果曲线呈等幅正弦状那是参数还压在临界点上。数据一画出来问题定位比听声音靠谱一百倍。串口初始化和发送代码不复杂注意用11.0592MHz晶振配9600波特率时定时器初值误差为零这是最标准的组合。5.2 两类关键测试阶跃响应和负载扰动参数定完得跑两个标准测试才算真正验证。第一个是阶跃测试设定转速从600转直接跳到1200转看转速曲线的上升时间、超调量和调节时间。我最终这组参数的表现是上升时间约0.35秒超调在5%以内大约0.6秒内进入正负5转的稳态带。这个表现对一般小型设备完全够用。第二个是负载扰动测试电机稳定在1000转时用手轻捏电机轴模拟负载突变。注意不要完全捏死防止电流过大。捏住瞬间转速掉了大约80转松开后约0.5秒内恢复回1000转。恢复速度靠P项能不能回得到设定值靠I项——如果捏住后转速拉不回去说明Ki偏小或者积分限幅卡得太死。还可以做一次供电扰动把12V电源换成9V试一次。转速如果还能稳定在设定值说明闭环对母线电压波动有真正的抑制作用这也是开环系统做不到的。5.3 常见故障排查表整理一下我踩过和见过的坑方便你对照排查现象可能原因处理方式电机完全不转驱动使能脚没拉高、PWM脚接错、电源功率不足检查IN/EN引脚电平用示波器或逻辑分析仪看PWM波形转速疯狂乱跳单片机与驱动电源未共地、编码器线受干扰确认共地编码器线绞合或做RC滤波必要时加上拉电阻设定1000转只能跑到800P太小或I项没起作用适当加大Kp检查积分限幅是否太紧启动瞬间猛冲一下积分饱和加积分分离、积分限幅、输出限幅稳态等幅震荡Kp偏大、缺D项、滤波不足降Kp、提高滤波强度、谨慎加Kd占空比波形毛刺多逻辑电源纹波大加强电源滤波电容编码器线远离PWM线电机有明显高频噪声PWM频率偏低调高硬件PWM时钟分频或改用带硬件PWM的芯片调试时还有一条经验每次只改一个参数改完必须重新上电跑一次完整测试。连续改三个参数再一起测试出了问题根本不知道是哪一个的锅。最后说一点个人体会。这个项目做完之后我最深的感触是PID本身不难公式背下来五分钟代码抄一遍十分钟真正决定成败的是三件事测速分辨率够不够、控制周期和反馈量化匹不匹配、积分饱和这类工程细节有没有处理到位。很多系统调不稳不是算法不行是反馈通路的精度配不上算法的胃口。另外如果你还没买电机我强烈建议直接选带光电编码器的高分辨率型号别在13脉冲的霍尔电机上省钱——省下的钱最后都会变成调试时的头发。先把这一套跑通后面不管是改成按键调速、加数码管显示还是换串口下发目标转速都只是在这个骨架上添砖加瓦的事。
平方复杂度无法被常规优化消除｜TaoToken 统一 Key 通道实测)
