很多第一次把FOC代码烧进板子的人都会有一个困惑这程序到底是怎么转起来的编译下载之后打开变量观察窗口看到的是一堆密密麻麻跳动的数字完全不知道哪一行代码在什么时刻被执行。其实FOC框架的程序环流程就是整个控制器的血液循环系统搞清楚它读代码和调Bug的效率完全不一样。这篇继续凌欧通用FOC框架的系列解析前面几篇聊了整体框架、电流采样与硬件设计这一篇专门讲程序环流程中断里怎么跑电流环、主循环里怎么调度慢环、无感启动怎么切闭环、状态机怎么防止系统飞了。凌欧通用FOC框架的程序环设计思路和市面上主流FOC框架ST SDK、SimpleFOC、VESC有相似之处但它在流程划分、状态切换和保护机制上有自己的一套取舍尤其适合做无感FOC和电流速度FOC控制的人学习。无论你是刚入门的无感FOC学习者还是在做PMSM无感FOC控制的工程师或者正被FOC调试难点折磨的老手这篇文章都值得从头读到尾。下文所有流程都是基于实际代码精简后的结构不同版本的寄存器名可能有差异但逻辑骨架是一致的。1. 程序环为什么必须快慢分层凌欧框架的调度骨架1.1 三个闭环的物理时间常数决定了执行频率FOC控制的本质是三个闭环电流环、速度环、位置环。三个环的执行频率必须由快到慢逐级递减这不是代码风格偏好而是受控对象的物理规律决定的。先看电气量电机定子绕组是电阻和电感的串联电气时间常数通常只有几毫秒甚至亚毫秒。电流必须被高频调节否则电流波动剧烈、转矩脉动大、电机发热严重。再看机械量转子本身有转动惯量速度变化是慢过程机械时间常数往往是电气时间常数的几十倍。因此速度环没必要和电流环一样快位置换就更慢了。如果尝试把三个环都塞进同一个while(1)大循环里顺序执行程序会非常尴尬循环里一旦有通信处理、按键扫描这种耗时操作电流环的执行周期就会抖动电流波形随之产生毛刺。你可能觉得周期抖动几十微秒无所谓但电流环对执行时间的一致性极度敏感周期抖动直接表现为占空比抖动最终在相电流波形上看到毛刺电机噪音变大、开关管应力变差。所以所有实际可用的FOC框架无一例外都采用快慢环分治。1.2 主循环与中断循环的职责边界凌欧框架的调度骨架分三层最快层PWM中断或ADC中断频率等于开关频率典型值8kHz到20kHz。这一层只跑电流环、保护逻辑和观测器更新无感模式。中间层主循环里的速度环和位置环通过节拍计数器分时调度典型值1kHz和500Hz。慢速层主循环里的通信处理、状态机、参数修改、故障恢复按需执行不占固定节拍。中断里跑电流环主循环里跑慢环这个分工有两个直接好处。第一电流环的执行频率与主循环里做什么完全解耦无论通信处理多繁忙电流环的周期始终严格等于PWM周期。第二慢环可以容忍执行时间的微小抖动比如串口一帧数据解析耗时掉0.5ms这对1kHz的速度环影响可以忽略。从代码结构上看主循环不应该出现任何阻塞延时。一旦delay_ms(5)出现在主循环里通信处理延迟、故障扫描延迟、速度环节拍全部跟随抖动FOC就再也不丝滑了。凌欧框架在主循环里用一个节拍计数器来分发任务本质上是把时间片调度功能下沉到主循环内部后面第3章会展开讲。1.3 跨环数据交换的防撕裂处理这是程序环设计中最容易被忽略的一环但实际工程里踩坑概率极高。主循环和中断之间要交换很多变量速度环算出的iq_ref要让电流环用位置环算出的speed_ref要让速度环用上位机改写的PI参数要让电流环读取。问题在于中断随时可能打断主循环的赋值操作。举个例子主循环里正在写一个4字节的浮点变量iq_ref写到一半突然来了PWM中断此时中断里的电流环读取iq_ref就会得到一半新值一半旧值。如果新旧值差异很大比如速度环更新了一版iq_ref而电流环正好读到撕裂值等效电流瞬间跳变轻则噪声重则过流。凌欧框架的做法是对环间共享变量做原子访问保护具体有两种手段一是关中断赋值在写入的关键时刻屏蔽PWM中断写完后恢复二是使用双缓冲副本主循环写副本电流环读主副本依靠一个更新标志来切换。我强烈建议每个自研FOC框架都用同样的手段这个坑我实际踩过一次表现是电机高速转的时候偶尔咔一声查了小半个月才定位到是iq_ref撕裂读取。2. 电流环在中断里的完整执行流程从ADC采样到SVPWM更新2.1 从ADC采样到PWM更新的十个步骤FOC的电流环是结果最明确的一段流程从采样到占空比更新基本是一个单向流水线。凌欧框架在ADC中断与PWM同步触发里依次执行十个步骤读取ADC电流采样值两相电流第三相由基尔霍夫定律推算。电流零位偏移修正。获取转子角度编码器、磁编码器或观测器估算值。Clark变换把三相静止坐标系转到两相静止坐标系。Park变换把两相静止坐标系转到两相旋转坐标系。电流误差计算与PI调节得到d轴和q轴电压指令。电压前馈补偿反电动势解耦。反Park变换把d/q轴电压指令转到两相静止坐标系。SVPWM调制计算三相占空比。更新PWM比较寄存器。这段流程的伪代码如下不同版本的寄存器名有差异但结构一致void PWM_ISR(void) { DEBUG_PIN_HIGH(); // 调试点用来量中断执行时间 // 1. 读取两相电流第三相推算 ia adc_buf[0]; ib adc_buf[1]; ic -ia - ib; // 2. 零位偏移修正 ia - ia_zero_offset; ib - ib_zero_offset; // 3. 转子角度采集 theta get_rotor_angle(); // 4. Clark变换 i_alpha ia; i_beta (ia 2.0f * ib) * 0.577350269f; // 5. Park变换 sin_t arm_sin_f32(theta); cos_t arm_cos_f32(theta); id i_alpha * cos_t i_beta * sin_t; iq -i_alpha * sin_t i_beta * cos_t; // 6. 电流环PI vd pi_update(pi_d, id_ref, id); vq pi_update(pi_q, iq_ref, iq); // 7. 反电动势解耦前馈 vd vd_feedforward; vq vq_feedforward; // 8. 反Park变换 v_alpha vd * cos_t - vq * sin_t; v_beta vd * sin_t vq * cos_t; // 9. SVPWM占空比计算 svpwm_calc(v_alpha, v_beta, duty_a, duty_b, duty_c); // 10. 更新比较寄存器 pwm_set_duty(duty_a, duty_b, duty_c); // 保护逻辑与观测器更新 protection_check(); if (sensorless_mode) observer_update(ia, ib, v_alpha, v_beta); DEBUG_PIN_LOW(); }2.2 采样触发时刻与零漂处理采样时刻为什么这么关键PWM中心对齐模式下载波顶点时刻电感电流的纹波正好回到平均值同时开关管切换造成的共模干扰也在这一瞬间最小。ADC触发必须和PWM同步设置在顶点不要在计数零点或比较值突变处采样否则采出来的电流叠加了大量开关噪声反馈到电流环里就是占空比抖动占空比抖动又造成电流纹波变大形成恶性循环。凌欧框架在PWM配置里用一个定时器同步事件去触发ADC所有通道采集完再进中断从根本上保证采样同步。如果你在自研框架里遇到电流波形异常第一步永远是拿示波器看PWM同步信号和ADC触发信号是否严格对齐这个排查成本最低但收益最大。零漂问题同样容易被忽视。电流传感器霍尔、采样电阻运放在零电流时输出电压不可能是绝对的ADC中值运放失调、温度漂移都会造成零点偏移。如果不在程序环里做零漂校正反馈电流就带着直流分量直轴和交轴电流轨迹在示波器上呈现偏心圆实际表现是电机空载电流偏大、低速抖动。凌欧框架在电机停止时采集几十次电流取平均作为零漂值存下来每次进入中断时减去这个偏移量。这个校正必须在电机上电后静止状态下执行电机一旦转起来得到的平均值就混合了真实电流校出来的偏移量是错的。2.3 电流PI的积分抗饱和与前馈补偿电流环PI调节器在程序环里的实现有三个必须处理的细节。第一积分分离。当速度环修改了iq_ref电流误差瞬间变得很大如果积分项还按常态累加容易超调。凌欧框架的PI结构里带积分快速清零逻辑每次速度环更新目标值到电流环执行之间电流PI的积分项会按设定轨迹衰减或者直接清零避免目标值阶跃时积分项冲过头。第二输出限幅和积分抗饱和。当PI输出到达电压限幅时积分项必须停止累加否则会产生积分饱和表现为恢复瞬间大超调。说得直白一点你想让电流快速上升但PWM已经顶到最大占空比了PI的输出还在往上积等到电流终于追上目标时积分项仍然很大输出还是满的电流继续超调等积分项慢慢退下来已经过了好多个周期。所以程序环里必须在每次PI运算前判断输出是否达到限幅达到就冻结积分累加。第三前馈补偿。如果只做PI控制而不做反电动势解耦高速时d轴和q轴会互相干扰你加大iqid会被拉偏动态响应明显变差。反电动势解耦的前馈项基本形式是vd_ff -omega * Lq * iq vq_ff omega * (Ld * id flux_f)其中omega是电角速度Ld和Lq是d/q轴电感flux_f是永磁磁链。前馈值不必在电流环里每周期重算可以在速度环里算好放到共享变量里电流环只负责读取。注意这个读取同样存在撕裂风险要用和共享变量一致的原子访问方式。3. 主循环中速度环与位置环的分时调度3.1 节拍计数器的分时调度逻辑速度环和位置环在主循环里怎么插空执行凌欧框架在主循环里维护了一个节拍标志每次循环判断是否到了对应任务的执行节拍。速度环典型值1kHz也就是每1ms跑一次位置环按需可以500Hz甚至更低通信模块每次循环都处理但不占用固定节拍。主循环的伪代码如下while (1) { if (tick_1ms_flag) { speed_pi_run(); tick_1ms_flag 0; } if (tick_2ms_flag) { position_ctrl_run(); tick_2ms_flag 0; } fsm_run(); comm_process(); fault_monitor(); }tick标志由定时器中断置位主循环只负责轮询这样设计的好处是即使主循环某一轮卡得比较久慢环任务也只会在下一个循环继续执行不会出现重入问题。这里我想特别强调一点不要用阻塞延时来做慢环节拍。很多从单片机裸机开发转过来的人喜欢在主循环里delay一次延时5ms看起来没毛病但通信处理和故障扫描全被延后了。假如串口正在接收上位机下发的参数一帧数据分多次接收接收过程中主循环卡了5ms串口缓冲区溢出参数写不进。所以FOC框架里的主循环必须是无阻塞轮询结构。3.2 速度环输出iq_ref的两层限幅速度环的本质是速度PI调节器输出的是q轴电流指令iq_ref。核心语句可以简化为speed_pi_out kp_speed * (speed_ref - speed_fb) ki_speed * integral_speed; iq_ref limit_and_slew_rate(speed_pi_out, current_limit);这里我特意写了一个limit_and_slew_rate限幅加斜坡限制因为iq_ref的限幅必须做两层。第一层是速度PI输出限幅限幅值一般就是系统允许的最大电流。这一层很好理解速度误差再大电流也不能超过逆变器和电机的耐受值。第二层是变化率限制也就是斜坡限制限制iq_ref在单位时间内能变化多少。为什么要做这一层假设上位机突然给了个大的转速阶跃速度环输出瞬间就顶到限幅值如果iq_ref直接跳变到最大电流冲击电流和机械冲击都会很大。加斜坡限制后iq_ref是逐渐爬升到限幅值的电流变化柔和也更符合机械系统对力矩变化率的容忍度。LingOu框架里这个斜坡限制的速度是可以配置的单位是安培每秒。我调试时一般取额定电流的10倍每秒作为默认值比如额定电流10A斜坡限制就是100A/s从0到额定电流需要0.1秒。这个值不是越大越好也不是越小越好需要根据负载的转动惯量和应用场景折衷。速度反馈的来源也要注意。有传感器时用编码器差分计算代码上分M法测频率和T法测周期两种无感时用观测器估算速度。无论哪种速度环的执行频率不能超过传感器速度更新的实际分辨率否则会引入大量量化噪声。比如编码器线数很低速度环频率却很高就会出现速度反馈跳变、噪声放大的现象。3.3 位置环与指令轨迹规划位置环在凌欧框架里不是直接对位置误差做比例控制这么简单。如果直接做P控制目标位置阶跃远的时候速度指令会瞬间顶到极限电机会猛加速然后猛减速机械冲击损毁设备。实际框架会先做轨迹规划把目标位置翻译成一条梯形速度曲线或S形速度曲线位置环输出速度指令速度环再跟踪这条速度曲线。这样就形成了指令信号发生器三级跟随器的级联结构位置环输入来自上位机预设的目标位置输出是速度指令speed_ref。速度环输入是speed_ref输出是q轴电流指令iq_ref。电流环输入是iq_ref输出是PWM占空比。三级环的数据流永远是单向的位置环算得快慢不影响速度环速度环算得快慢不影响电流环只要接口变量做了撕裂防护各层之间就是松耦合的。这也是FOC框架能稳定运行的基础。从执行频率上看三个环的典型值和反馈来源可以整理成一张表控制层级典型执行频率反馈来源输出电流环8kHz~20kHzADC采样电流、角度vd、vq速度环0.5kHz~2kHz编码器/观测器速度iq_ref位置环100Hz~1kHz编码器/观测器角度speed_ref位置环下面还能挂梯形曲线发生器曲线发生器本身不参与闭环反馈它只负责生成一条平滑的速度参考曲线算出来的speed_ref才送给速度环。这样一来位置指令的大跳变被曲线发生器消化了整个级联结构承受的冲击就小很多。4. 无感FOC启动链路程序环里最容易出错的一段4.1 转子初始位置检测的三种实现很多人的问题都集中在无感FOC启动上核心难点第一关就是转子初始位置检测。无感模式没有编码器告诉程序转子当前转到了哪个角度而FOC的Park变换又必须知道精确的转子角度启动前必须先解决我在哪里的问题。凌欧框架里有三种初始位置检测方式区别在负载能力和代码复杂度预定位法发一个固定方向的电压矢量把转子硬拉到一个已知角度。实现最简单空载或轻载场景下可靠缺点是转子会转动一下有些应用不允许这种位移。脉冲矢量检测法轮流在多个方向发短脉冲电压比较电流响应幅值判断磁极方向再用正反脉冲做磁极极性区分。转子基本不移动适合有一定负载的场合。核心原理是利用d轴和q轴磁路的差异脉冲电压方向越接近转子d轴电感越小、电流响应越大。高频注入法在估计d轴注入高频电压信号从高频电流响应中解调出位置误差再收敛到真实角度。零速带载能力最强但算法复杂度高对电机凸极率有要求不是所有电机都适合。凌欧框架的默认做法是先走预定位等电流稳定后再用脉冲矢量法确认一次磁极。这样做的逻辑是预定位负责把转子拉到一个大概位置给脉冲法一个初始参考脉冲法负责验证和纠偏防止预定位因为负载力矩太大而没拉到位。两级配合下来简单场景不增加成本复杂场景也有保底精度。这个阶段在代码里是放在主循环状态机的ALIGN状态下执行的完成标志置位后才切到START。我调试时的经验是定位阶段的作用时间不能太短尤其是大惯量负载转子被拉过去需要时间一般至少给100ms以上。时间太短转子还没稳定位置其实还是错的。4.2 开环强拖用手扶着转起来转子初始位置检测完成后程序环进入开环强拖阶段。这个阶段的本质是用手扶着转起来既然观测器在零速和极低速下无法可靠工作反电动势太弱信噪比太低那就先不给转子精确的控制角度而是直接给一个旋转的电流矢量强制转子跟着转。相当于先把转子带起来等转速足够高、反电动势足够强的时候再把控制权交给观测器和闭环。凌欧框架的实测代码里开环强拖用I/F方式实现电流环仍然正常工作但id_ref设置为0iq_ref固定为一个启动电流值角度不是来自观测器而是程序自己以固定斜率递增。也就是说程序假装知道角度用一个匀速旋转的虚拟角度去驱动Park变换和反Park变换实际上转子在电流矢量牵引下跟着转。程序的启动参数有两个是最关键的启动电流和角度加速斜率。启动电流通常取额定电流的1.5倍左右。太小了拖不动负载尤其是有静摩擦或带载的场合太大了容易过流或者强拖过程中发热严重。角度加速斜率对应转子的加速度斜率越大启动越快但越容易失步。我调试时会让加速率从很小开始试比如200rpm/s如果电机起得来且不抖动再逐渐加大带重负载时一般减半处理。开环强拖阶段容易出现的坑是电机发出了嗡嗡声但不转。这通常意味着启动电流不够或者加速斜率太大、转子跟不上虚拟角度的变化。还有一种情况是定位阶段根本没有定位成功转子在错误的角度上被强拖表现为电流很大但转矩很小。4.3 观测器切入与闭环平滑切换切换闭环是整个无感启动成败的关键。凌欧框架的切换条件有三个全部满足才允许切换转速达到阈值一般取额定转速的5%到10%。太低时观测器速度估计抖得厉害切换后容易振荡太高会浪费启动时间启动过程看起来拖沓。观测器角度收敛角度误差在设定阈值范围内并且持续一段时间。持续确认这一步很重要观测器偶尔会有一两个周期的角度跳变瞬时满足不代表稳定收敛。强拖电流无持续超调说明负载变化不剧烈切换起来不会猛冲。三个条件都满足后程序环做一系列平滑交接动作。第一步将强拖用的虚拟斜坡角度替换为观测器输出角度。替换前必须检查两个角度是否在允许偏差范围内如果偏差太大说明强拖过程中转子已经和虚拟角度错位了硬切会导致电流瞬间跳变。正确做法是延长切换等待等虚拟角度和观测器角度跑拢了再切。第二步将强拖用的固定iq_ref替换为速度环输出iq_ref。同样不能瞬时跳变要用斜坡渐变的方式切换。一般让强拖电流在几十毫秒内逐渐过渡到速度环输出的值这样电流的变化是连续的力矩不会突变。第三步速度环的积分项要做预置。直接让速度环切入积分项从0开始累加会导致切入瞬间速度环输出很小和强拖电流之间出现一个台阶。凌欧框架的做法是把强拖电流值作为速度环积分的初始值相当于速度环已经热身好了接手的瞬间就能输出接近强拖电流的值然后再根据速度误差逐步调整。这段逻辑在程序环里通常表现为一个小的状态子机代码结构类似case START: if (smo_angle_ready speed switch_speed) { if (angle_error ANGLE_LIMIT) { state RUN; iq_ref_ramp_start current_iq_forced; } } break; case RUN: // iq_ref从强拖值在设定时间内渐变到速度环输出 iq_ref ramp_to(speed_loop_output, iq_ref_ramp_start, ramp_ms); break;切换瞬间如果电机咔的一声或者电流尖峰优先检查两个地方切换前提的角度差限值以及iq_ref渐变时间。这个经验来自我实际调无感FOC的过程波形上的异常最常出现在切换前100ms和切换后200ms只要这段时间电流是平滑的整个启动就算成功了。步进电机做FOC的启动流程其实完全一致只不过步进电机是磁阻加永磁混合结构凸极性强、电感小初始位置检测用脉冲法或高频注入可以做得很准。步进电机一般不需要零速大扭矩预定位法很多时候也够用。如果你想拿凌欧框架带步进电机做位置控制程序环不用改改电机参数和启动策略就行。5. 主循环状态机与调试通信通道防止系统飞了的核心设计5.1 生命周期状态与状态切换规则一个FOC系统不是只有运行态。从用户按下启动键到运行中遇到故障整个生命周期都应该在状态机里被逻辑化。凌欧框架的主循环里有一个精简但完整的有限状态机状态定义通常包括IDLE待机状态PWM没有输出等待启动指令。ALIGN定位和初始位置检测阶段。START开环强拖阶段。RUN闭环运行阶段。FAULT故障保护阶段。STOP软停机阶段。为什么必须用状态机而不是直接在主循环里写大量if else因为状态机会让每个阶段的入口和出口变得明确。比如从RUN进入FAULT要执行封波、记录故障码、停止速度环三件事如果这些操作散落在主循环的各段代码里漏掉任何一个都会留下隐患。状态机把所有进入某个状态时应该做什么收敛到一个地方可读性和可靠性都明显更高。状态机在主循环里执行执行频率不需要很高状态切换是慢动作事件。但状态机与电流环之间有个关键的交互电流环在中断里不跑状态机但它会读取状态机设定的运行模式标志比如是否封波、是否处于强拖阶段。这些标志必须在中断里用于保护判断如果封波标志已经置位电流环这周期就不能再输出PWM占空比。5.2 故障分级与自恢复策略凌欧框架的FAULT状态不是单一的状态而是带故障码和恢复等级的。程序环里常见故障包括过流、过压、欠压、堵转、过温、通信超时、编码器断线。故障分级的意义在于恢复策略不同。一级故障比如瞬时过流、通信超时可以自动恢复延时几百毫秒后尝试重新启动。二级故障比如过压、堵转、过温需要人工干预或者满足特定条件才能复位例如温度降到安全区间以下。三级故障比如硬件自检失败、编码器断线必须整机上电复归不能自己恢复。把故障分级放进程序环里实际效果是瞬时过流后电机自动重启用户不需要停机而过温会一直停在FAULT状态直到温度回落。很多烧板子的案例是三级故障未处理过压一直累积最终功率管击穿。所以故障状态的处理不是简单的封波停机而是要有策略的。软停机状态也值得一提。正常停机不是直接把PWM封掉否则大惯量负载会因为立即卸掉力矩而猛冲一段。凌欧框架的软停机逻辑是先让速度环以设定减速度斜坡降到0然后切换到IDLE最后才封波。这个流程在状态机里表现为STOP状态到IDLE状态的转换期间程序环持续运行控制算法只是目标速度在往下走。5.3 非阻塞通信与寄存器映射调参通信模块在程序环里的地位说起来不算控制环但调试时它是命脉。凌欧框架用的是寄存器映射通信方式上位机通过串口或CAN直接读写变量地址。这种设计的好处是不需要为每个参数写单独的接收协议分支主循环里只要有一个参数读写执行器上位机发什么地址就读写什么寄存器代码量小且扩展性好。程序环侧需要保证的是通信处理不能阻塞控制链。串口接收、校验、组帧、应答全部做成非阻塞状态机逐字节接收收到一帧完整数据再统一解析。这样即使串口在主循环里慢慢收也不会卡住速度环的节拍。我的调试习惯是用上位机在线改PI参数这比改代码重新编译烧录快得多。但前提是代码里要给每个可调参数加范围保护上位机写进寄存器的值如果超出合理范围框架会直接拒绝写入防止在电机运行时把P参数改成100倍把系统打飞。这个范围保护看起来是小事但关键时刻能救一块驱动板。6. 程序环调试的常见坑与完整排查链路6.1 电流波形异常与电机噪音的排查FOC调试难点集中在波形异常、噪音、启动失败、中断超时这几个方向我按程序环相关的常见坑整理一下排查思路。电流波形毛刺严重时先确认采样时刻用示波器测PWM中心对齐信号和ADC触发信号是否严格同步不同步就会采到开关噪声。再查电流零漂电机停止时电流读数应当接近0如果漂移了几个LSB反馈电流就含有直流分量波形上表现为id和iq轨迹偏心。最后查速度环输出iq_ref是否在电流环允许范围内是否存在撕裂读取的问题。电机低速抖动、高速尖叫涉及的问题点更多。低速抖动优先查位置反馈分辨率编码器线数低、分辨率不足速度环的反馈量化噪声会被放大表现为低速时转速忽快忽慢。高速尖叫大部分是电流环PI增益太高或者前馈解耦没做q轴对d轴的干扰反馈成高频噪声。另外死区补偿也值得检查占空比较小时死区影响占比大噪声尤其明显。如果程序环里没有做死区补偿高速弱磁段很容易听到刺耳的啸叫。6.2 无感启动失败的完整排查链路无感启动失败的排查需要沿着程序环的阶段一步步定位不能跳着猜。我给一个可以复现的排查链路观测开环强拖阶段的电流有没有建立。如果电流没建立说明强拖阶段的iq_ref或虚拟角度递增没有生效优先检查状态机是否从ALIGN正确进到START。观测转子在定位阶段有没有位移。完全没有位移就检查定位电压矢量的幅值和作用时间是不是不够尤其观察是否有负载力矩把转子压住了。判断是不是失步。强拖过程中转子没跟上虚拟角度表现为电流逐渐增大但转速不上升或者电机有明显的咕噜咕噜声。查看切入瞬间的切换条件。把观测器是否收敛、转速是否达到阈值、角度差限值是否满足都通过通信打印出来看卡在哪一个条件。如果所有条件都满足但仍然切换失败重点检查观测器角度是否出现0度和360度之间的来回跳变这是角度换界处理没做好。这套链路我每次调新板子都会走一遍能覆盖掉九成以上的启动问题。6.3 中断执行时间的测量与优化程序环性能最直接的指标就是中断执行时间。测量方法很简单在中断入口拉高一个GPIO出口拉低用示波器量高电平宽度。目标值应该小于开关周期的70%。比如20kHz开关周期是50微秒电流环执行时间最好控制在35微秒以内剩下30%给ADC采样、硬件保护响应和其他中断留余量。如果超过了电机容易在高速大电流工况下出问题因为中断还没算完下一次PWM事件已经来了控制节奏被打乱。发现超时后优先排查中断里有没有调用标准的浮点库函数特别是开方、反正切、sin/cos。这些函数动辄几微秒非常拖时间。解决方式有几种用查表替代三角函数用定点算法替代浮点把观测器里非线性部分拆到慢速任务里算。凌欧框架里sin/cos和反正切都有查表版本目的就是保证中断周期的确定性。关于无感FOC的观测器程序环里最核心的问题是观测器跑多快。凌欧框架的滑模观测器在电流环中断里同步执行频率和电流环一致这样角度延迟小切入闭环时抖动也小。但高频执行的代价是中端负载变大。如果你发现中断时间占用率过高可以把观测器拆开高频部分状态矩阵更新放中断低频部分角度提取PLL放慢速任务前提是相位延迟不能超出允许范围。这个取舍要看具体电机的额定转速转速越高对角度延迟越敏感越不建议把观测器拆开。最后聊聊参数在线整定的一点个人经验。速度环PI参数和电流环PI参数是分开整定的顺序一定是先电流环后速度环。电流环整定时先给一个小幅度的iq_ref阶跃用示波器看iq的响应波形调整P让响应达到临界阻尼再加一点I消除稳态误差。然后整速度环同样是看阶跃响应但速度环整定一定要在电机连续运行时进行而且要盯住电流是否超限。程序环里如果做了寄存器映射通信这个过程就很舒服参数在线改波形在线看不用一遍遍重新编译烧录。这也是我把凌欧框架程序环流程称作血液循环系统的原因信号流、状态流、数据流全部要通畅任何一环堵了整个系统都会立刻表现出不正常的症状。
