★ FEATURED ARTICLE 干电机控制这行久了你会发现一个现象产品经理嘴上说“通用平台”落到代码里往往只是把相同的FOC流程复制了三份。PMSM一份、直流无刷BLDC一份、三相异步电机又一份底层的采集、变换、保护逻辑却要维护三套。直到最近梳理一套基于DSP28335的矢量控制工程我才真正留意到一套架构把PMSM、直流无刷、三相异步电机统一进同一个FOC框架里的价值。程序内置双闭环电流环速度环和三闭环位置环速度环电流环两套结构全部C代码实现可以直接移植到C2000系列的DSP28335上跑。这篇文章不打算讲教科书上的电压方程和坐标系公式而是以拿到这套源码之后的视角拆解它的实际组成、关键分支、调参顺序和移植注意事项。无论你是刚开始做FOC的新手还是从其他MCU转DSP的工程师这套程序的取舍逻辑都能省下不少弯路。1. 一套工程吃下三种电机这套FOC程序解决了什么问题1.1 “矢量控制”为什么能同时覆盖PMSM、BLDC和异步机先把话头聊透。很多人一看到“PMSM、直流无刷、三相异步电机”就以为代码里写了三套完全不同的算法其实它们共享的底层数学模型是同一个在旋转坐标系d-q轴下把定子电流分解成励磁分量id和转矩分量iq然后分别控制。区别只出在三个地方转子磁场从哪里来、转子位置怎么获取、磁链要不要额外建立。PMSM永磁同步电机转子是永磁体天然有磁场。做矢量控制时只需要知道转子位置然后把电流分解到d-q轴通常采用id0控制把所有电流都用来出力矩。动态响应快效率高这也是伺服领域最常用的电机。直流无刷BLDC转子同样有永磁体但反电动势波形是梯形的。传统上很多人用六步换相方波驱动噪声大、转矩脉动明显。现在很多工程把BLDC也放进FOC框架做正弦驱动换相代替方波换相转矩平滑许多。代码上它和PMSM的区别并没有想象中那么大主要要处理反电动势谐波带来的电流纹波以及弱磁区间的额外补偿。三相异步电机转子本身没有磁场转子电流全靠定子磁场感应产生。所以矢量控制必须先建立稳定的励磁电流id再给转矩电流iq。转子磁场的位置不是直接靠编码器量出来的而是通过转速加上转差估算出来的。异步机FOC的动态响应略慢于同容量PMSM但过载能力强、弱磁范围宽工业驱动里依然大量采用。所以一套FOC程序要通吃三种电机关键不是写三套算法而是把“角度来源”和“电流指令生成”两个模块做成可切换的。角度来源解决的是坐标变换的基准方向电流指令解决的是d-q轴到底给多大电流。这两块切对了后面的电流环PI、SVPWM、采样滤波全都可以复用。这套程序的核心设计思路就是把变化的浓缩到配置和浅层接口里把不变的沉淀到调用链里。1.2 双闭环与三闭环不是功能堆叠而是带宽分层标题里写了“包含双闭环及三闭环”很多人会下意识理解成两套代码或者两个文件。实际上程序里的含义很直接双闭环就是在最外层加速度环形成“速度环电流环”的结构三闭环则是在速度环外面再套一个位置环形成“位置环速度环电流环”的结构。哦这里必须说清楚电机控制里讲三闭环业内默认第三个环是位置环很少有把第三个环做成功率环或转矩环的。这两个结构在程序里通过一个模式枚举切换并不是两套割裂的代码。不过结构上是一件事控制思想上又是另一件事。三环存在的意义不是为了“看起来更强”而是为了让不同频段的控制分工明确。位置环负责把当前位置送到目标位置输出的是速度指令它的响应要慢带宽通常只有几个赫兹速度环接收位置环给的速度指令输出电流指令带宽一般在几十赫兹电流环是响应最快的内环带宽几百赫兹到上千赫兹。三层带宽必须拉开否则外环的微小抖动传进内环系统就会振荡。程序里的做法是把每个环的PI参数分开放位置环、速度环、电流环各自限幅、各自抗饱和切换模式和参数整定的时候互不干扰。这样设计的好处是你在调试速度环的时候不会因为位置环的积分饱和而误判问题而你把系统切成双闭环时位置环PD直接被绕过速度指令来源变成外部给定逻辑链路依然干净。很多从单环调起的人第一次接触这种结构会觉得中间变量太多实际上逐层剥离来看每条信号链路都是完整的。2. 28335上的控制框架采样、变换、SVPWM输出一条龙2.1 硬件资源怎么分配PWM、ADC、编码器接口DSP28335是C2000系列里很经典的浮点DSP主频可以跑到150MHz电机控制该有的外设基本都齐了。这套程序在板级层面的分配方式也比较典型用ePWM模块生成6路互补PWM带死区插入和TZTrip Zone硬件故障保护电流采样用ADC模块的同步触发功能通常采A相和B相两路电流母线电压再占一路编码器接qEQP模块直接用硬件正交解码减轻CPU负担。硬件分配里有几个细节容易被忽略。第一ADC的触发不是自己定时的而是由ePWM产生SOCStart Of Conversion信号触发这样才能保证采样点和PWM载波在相位上严格对齐。正常的做法是把采样时刻放在上下桥臂开关动作的中间通常是载波周期的波峰或波谷位置这时候电流波形最干净串扰最小。第二TZ模块一定要接硬件过流信号一旦电流超过阈值直接封锁PWM输出这个功能不能靠软件延时替代。第三28335的ADC是12位满量程对应3V或0~3.3V换算电流值时要注意偏置电压的处理。程序里一般在采样通道上叠加一个1.65V的偏置把双极性电流抬高成单极性电压代码里再做一次偏置回退。2.2 中断里的FOC主循环时序设计决定控制品质这套程序最核心的部分其实是那个中断服务函数。控制频率一般设置在10kHz到20kHz也就是每100微秒或50微秒执行一次完整的FOC流程。大致顺序是先读ADC结果寄存器拿到ia、ib、vbus再根据电机类型算电角度和转速然后看模式是双闭环还是三闭环决定速度指令从哪儿来接着跑速度环、电流环得到vd和vq最后做逆Park变换、逆Clarke变换把结果交给SVPWM模块更新比较寄存器。这里可以直接看一个示意结构方便理解调用链长什么样interrupt void PwmIsr(void) { /* 1. 采样结果读取 */ ia ADC_GetResult(ADC_A0); ib ADC_GetResult(ADC_A1); vbus ADC_GetResult(ADC_B0); /* 2. 位置与速度反馈 */ theta_elec GetElectricAngle(motor); speed GetSpeedRpm(motor); /* 3. 三闭环模式位置环输出速度指令 */ if (ctrl.mode MODE_3LOOP) { speedRef PosLoop(posRef, posFb); } /* 4. 速度环和电流环 */ iqRef SpeedLoop(speedRef, speed); idRef MotorGetIdRef(motor); /* PMSM/BLDC为0异步机为励磁电流 */ vd CurrentLoopD(idRef, id); vq CurrentLoopQ(iqRef, iq); /* 5. 逆变换与SVPWM */ InvPark(vd, vq, theta_elec, valpha, vbeta); SVPWM_Calc(valpha, vbeta, ta, tb, tc); PWM_UpdateDuty(ta, tb, tc); }这段只是核心流程的示意实际工程里还会加软件过采样滤波、自动故障清除、上位机指令解析等功能。但刻意别在中断里做printf、延时或动态内存分配这一点写程序的时候深有体会28335算力再强也经不起中断里花几毫秒去处理其他任务。控制品质首先来自稳定的时序FOC中断周期的抖动越小电流波形和噪声表现越理想。为了保证这一点程序里的常量往往是提前计算好的三角函数用查表或者近似展开来做避免执行时间忽长忽短。3. C代码层怎么区分三种电机几个关键分支与统一抽象3.1 角度来源同步机看编码器异步机算磁链拿到这套代码最先要看懂的就是角度是怎么来的。因为电角度一旦错电流解耦就错速度环输出再准也是白搭。PMSM和BLDC的转子磁场在物理上就是永磁体所以电角度与机械角度是刚性关联的电角度等于机械角度乘以极对数。代码里通常是直接读qEQP的位置计数器乘上极对数再对2π取模。上电时必须先确定转子初始位置所以整套程序里包含一个“找零位”的状态机有Z脉冲的增量编码器可以直接转一圈找Z信号没有Z信号的编码器就要在启动前用直流注入或特定占空比把转子预定位。异步电机就没有这么简单。转子磁场不是永磁体产生的而是定子电流感应出来的转子磁场方向与转子机械位置之间有一个转差。代码里怎么处理呢通常采用间接转子磁场定向IFOC转子电角速度 极对数 × 机械角速度 转差角速度。转差角速度与转矩电流iq成正比与转子磁链电流id成反比比例系数里还包含转子时间常数。写成代码就是slipSpeed motor.slipGain * iqRef / IFlux; theta_elec (polePairs * mechSpeed slipSpeed) * Ts;这个公式看着简单实际坑很多。转子时间常数受温度影响很大电机会发热参数漂了估算的磁场方向就会偏电流和力矩关系就紊乱。所以异步电机FOC程序通常需要一个在线辨识或参数补偿模块。那套程序里虽然保留了简单的固定参数版本但同时也留着磁链观测器的接口给后续升级留了空间。3.2 电流指令PMSM/BLDC的id0与异步机的励磁分量电流指令这一块的差异更显眼。PMSM在基速及以下恒转矩区id0是最常见的控制方式所有电流都给转矩需要弱磁提速时才把id拉向负值。BLDC也一样不过BLDC的反电动势是梯形波用正弦驱动时电流谐波会偏大常有工程师通过注入少量谐波来抵消转矩脉动而基础指令仍然是id0。异步电机则完全不同它必须先有一个励磁电流id_ref数值通常是电机额定励磁电流的数值然后iq_ref由速度环输出决定。如果没有先建立励磁电流启动瞬间直接给iq转子磁场根本来不及建立电流很快就会冲到过流保护限。在代码实现上程序把“当前电机该给什么id_ref”封装成了一个独立函数MotorGetIdRef()。PMSM和BLDC走同一分支返回0或者查表弱磁值异步机走另一个分支返回固定励磁电流或磁链控制输出。这样设计的好处很明显电流环PI、采样滤波、SVPWM完全不受影响换电机类型时不用动中断内部的核心链路。你甚至可以在电机运行过程中动态切换这个函数的返回值这也为异步机做“启动先建立磁场稳定后切回id控制”留了操作空间。3.3 一套结构体管三种电机代码组织方式参考看完分支逻辑我更推荐去研究它的数据结构设计。程序用了一个MotorControl_t结构体把电机参数、控制参数、模式选择全装进去每切换一种电机类型就加载一套const参数表。这里给出精简示意typedef enum { MOTOR_PMSM, /* 永磁同步电机 */ MOTOR_BLDC, /* 直流无刷电机 */ MOTOR_IM /* 三相异步电机 */ } MotorType; typedef struct { MotorType type; float polePairs; float Ts; /* 控制周期 */ float encScale; /* 编码器线数换算系数 */ float R, Ld, Lq; float flux; float slipGain; /* 异步电机转差系数 */ float idRef; float kp_i, ki_i; float kp_s, ki_s; float kp_p, ki_p, kd_p; } MotorControl_t;运行时只需要维护一个全局结构体变量ISR里一律通过这个结构体取参数。切换电机时调用一次初始化函数把对应电机的参数表拷进全局结构体剩下的代码完全不感知电机类型的差异。这个抽象方式不算高深但很多人写代码时容易把所有参数散落在全局变量里参数一多就乱。等你调BLDC时候发现有个异步机的转差系数变量还在影响数值排查起来会非常痛苦。所以这个工程的结构组织值得模仿哪怕你最终不在28335上跑这种配置表驱动的设计也能直接平移到别的MCU工程里。4. 从双闭环到三闭环位置环的插入点与整定逻辑4.1 位置环放在哪里速度指令的生成与限幅三闭环听起来是“多了一个环”实际在代码里的改动却很小主要是位置环输出要作为速度环的给定并且要做好限幅和斜坡处理。程序里有一个切换变量双闭环模式下speedRef来自外部上位机或电位器给定三闭环模式下speedRef PosLoop(posRef, posFb)。位置环输入目标位置和当前反馈位置输出一个合理速度值。这个输出如果没有限幅位置误差一大速度指令直接就顶到最大速度冲击感强不说还可能造成过流。所以位置环输出后面必须跟着两个环节一个是输出饱和限幅另一个是一阶斜坡或S型规划器保证大跨度定位时速度指令是逐步爬升的而不是跳变。位置反馈本身怎么来在增量编码器方案里位置反馈是累计脉冲数乘以每脉冲对应的角度或毫米值。由于增量编码器不知道绝对零位所以三闭环模式下上电首先必须完成“回零”程序会先低速搜Z脉冲锁定机械原点或者先撞限位开关再偏移校准。这一步看似和PID无关实际是所有定位控制的地基。原点没找对位置环调得再漂亮也只是在一个错误坐标系下自嗨。4.2 三闭环的调序先电流再速度最后位置三闭环参数整定的顺序非常固定顺序错了后面就是一团乱麻。第一步断开速度环和位置环直接给逆变器一个开环占空比确认电流采样和坐标变换没毛病第二步闭环电流环让id、iq能够稳准快地跟踪给定第三步接上速度环给固定转速阶跃调速度环PI第四步最后才接位置环。位置环的带宽必须比速度环低一个数量级以上否则位置环的微小波动传到速度环速度环再放大一次系统就会出现低速抖动甚至持续振荡。位置环的控制结构也和速度环不太一样。多数速度环用PI就够了位置环却常见PD或者PID带微分前馈的形式因为位置误差积分容易导致超调实际定位主要靠比例项和微分阻尼。代码里位置环的积分项通常配了专门的积分分离逻辑误差大时不积分误差进入设定死区后才启动积分用来消除静差。这个细节我在调试转台类负载时深有体会位置环积分没有处理之前每次定位都会冲过头加了积分分离以后才真正靠得住。4.3 一个容易踩的坑机械回零和外置限位从双闭环切到三闭环时最容易被忽视的不是PI参数而是外部安全逻辑。双闭环下你就算速度指令给得不对电机也只是转得快或慢坏不了设备。三闭环下位置环带着积分和限幅如果机械装配里没有硬限位或者软限位值设得不对一旦位置反馈丢失或者上位机给了错误目标位置电机会全力奔向机械尽头轻则损坏丝杠重则撞坏结构。所以程序里专门预留了软限位比较位置环输出速度指令前先判断“目标位置是否在合法行程内”非法就直接封锁输出。在调试初期建议把速度环的限幅先设小再慢慢放开给硬件留一条退路。这个问题表面是代码逻辑本质是系统级安全设计移植到不同机型时机械行程数据一定单独配置不要沿用原工程默认值。5. 调参实战电流环、速度环、位置环的先后顺序与失败现象5.1 电流环先让内环稳电机调试最忌讳上手就调速度环内环电流环都没稳外环调得再久也不会收敛。我习惯的做法是先用开环占空比让电机转起来观察相电流波形。PMSM和BLDC直接给定一个电角度看到正弦电流没有明显毛刺和跳动才说明采样链路是可信的。电流波形如果有锯齿状抖动先查采样点是否避开了开关噪声如果波形整体有半波削底查母线电压是否塌陷或采样偏置是否偏移如果波形频率对不上查编码器极对数和机械反馈换算是否有误。这些基础物理问题不解决调PI毫无意义。电流环PI参数调试时可以直接给iq阶跃通过DAC或上位机观察iq跟踪波形。正常情况下在28335上、10kHz控制周期下电流环稳定时间应该在几百微秒到一两毫秒的量级超调量控制在10%以内。如果电流出现过大的高频振荡优先减小电流环比例增益kp而不是先动积分ki。电流环带宽过高时计算延迟和PWM更新延迟会形成相位滞后表现为高频啸叫和电流波纹这是离散系统固有的相位裕度问题单纯调PI很难根治必要时得降开关周期或加低通滤波。5.2 速度环稳态与低速抖动电流环稳了再切换到双闭环模式调速度环。速度环给定的阶跃响应要注意几个现象启动时有明显冲击声一般是速度环比例太大或速度指令没有斜坡稳态转速上下波动看速度反馈本身的滤波是否足够尤其是低速段。低速抖动这个坑很经典电机在50rpm以下转速反馈的脉冲密度不够速度计算值一跳一跳速度环PI收到这种输入自然会输出波动电流于是电机低速就一顿一顿。解决方案通常是提升测速分辨率用M/T测速或捕获定时器而不是靠PI参数硬扛。若确认编码器分辨率已经是物理上限那就提高速度滤波时间常数代价是速度环响应变慢需要做平衡取舍。5.3 异步电机特有的启动问题异步电机的调试更多问题集中在启动段。因为转子磁链建立需要时间如果启动就满iq电流会直接冲上过流保护阈值。我在程序调试里被这套逻辑教育过一次异步电机启动时先给固定的励磁电流id等转子磁链建立通常要等几十毫秒到几百毫秒然后才允许速度环输出iq。代码里直接体现在MotorGetIdRef()分支中异步机在上电或停机复位后先强制一个id建立阶段期间iq被限幅到很小磁链建立完成后再放开iq限幅。PMSM没有这个担心但要注意上电找零位时不要给太大电流去预定位否则会把负载撞出去必要时要配合使能时序一起做。放一张我在调试过程中常用的现象对照表方便现场排查现象可能原因优先调整方向电流高频抖动、有啸叫电流环P过大或采样点偏减小电流环kp检查PWM采样相位低速转速跳动编码器分辨率不足或速度滤波弱改用M/T测速加大速度滤波时间常数异步机启动即过流磁链未建立先给id励磁限制iq延时再加载位置冲过头位置环P过大或积分未分离降低位置环kp启用积分分离母线电压波动大电流指令变化过陡增加速度环输出斜坡限制6. 从Demo到量产移植到其他MCU平台时的取舍6.1 算法层与底层解耦才是移植关键这套程序到底是讲C代码所以移植问题必须提。DSP28335的ePWM、ADC、qEQP外设和大多数MCU差异巨大直接把整个工程拷到另一颗芯片上跑是行不通的。要移植的关键思路是把电机算法与硬件访问彻底分层。PWM更新、ADC读取、编码器计数这几个接口单独写成motor_hw.cFOC核心算法比如坐标变换、电流环、速度环、SVPWM全部放在motor_ctrl.c并且只通过接口函数读取采样值和写入占空比。这样一来替换平台时只需要重写底层接口算法层几乎可以不动。之前在某个项目里从28335往另一款MCU上迁移底层重写用了三天算法层真的一行没改问题全出在ADC触发时序上。这个经验很有价值花在接口抽象上的时间永远会在移植时加倍还给你。6.2 保护逻辑千万别删移植时最容易犯的错误是把保护逻辑误当成“非功能代码”删掉。软件里的过流保护、母线过压/欠压保护、速度超限保护以及PWM硬件故障封锁都是行车安全系统级别的存在。28335的TZ模块可以硬件封锁PWM很多MCU也有等效功能但不少人图省事只留了软件判断延时封锁导致故障发生到软件响应之前这一段空窗期没有保护。我的建议是硬件级保护必须排在最高优先级所有平台移植都要先验证PWM故障封锁引脚是否有效。一次电流采样异常或编码器断线如果没有硬件保护挡着炸管往往只在毫秒级别。6.3 编码器与电流采样的替代方案换芯片换平台时运动反馈方案也经常跟着换。增量编码器qEQP是28335的经典组合移植到其他MCU可能要面对SPI绝对编码器、霍尔传感器、甚至无感观测器。代码里只要做好接口抽象这些方案都只是替换GetElectricAngle()函数内部实现的问题。电流采样更是如此原工程用双电阻采样加母线电压换平台时如果要改成单电阻采样采样时序窗口会紧很多低速区间电流重构本身就容易失真这时候要适当降低低速转矩指令或提高开关频率才能达到类似效果。这些都不在算法层面而是系统集成层的取舍。一个慎重的原则是电机类型和反馈方案变化时宁可使用保守参数也不要直接沿用原机的PI参数和限幅值。最后再分享一点个人体会。这类多合一FOC程序最大的价值不在于“代码写得多么精妙”而在于它把电机控制里那些容易忽略的工程约束沉淀成了一套可复用的工程结构。真正接手这样的程序首要任务不是改参数而是把数据流链路走通角度从哪来电流怎么采指令如何分层保护如何触发。链路理解了换电机、换芯片、再加第三个闭环都只是配置和接口问题。反过来没有理解这个链路哪怕代码注释再清楚拿到手也只是雾里看花。希望这篇拆解能帮你把好几层窗户纸捅破。
阅读完成 · 觉得有帮助？
