如果你第一次把增量式编码器装到无刷电机上做FOC大概率会遇到这样的场景上电后给一个速度指令电机不是纹丝不动就是剧烈抖动电流还大得吓人。这时候先别急着调PID先把增量式编码器的零位校准做对。我在嵌入式电机控制的调试里踩过最多的坑就是电角度没有对齐导致电流环参数、速度环参数怎么调都白搭。这篇文章就把我在实际项目里用过的几种零位校准方法、踩过的坑和参数换算细节整理出来给正在调FOC的朋友一个参考。1. 为什么增量式编码器必须先校零位1.1 增量式编码器的天生缺陷上电不知道位置增量式编码器输出的是A、B、Z三路脉冲信号。A/B两相相位差90°用来测转向和位置增量Z相每转一圈只来一个窄脉冲作为机械零点参考。这套方案成本低、结构简单、响应快是中小功率无刷电机驱动器里最常见的反馈方式。但它有一个天生的缺陷它没有任何断电保存能力上电之后计数器只能从某个随机值开始累加你不知道当前转子到底在哪个机械角度上。也就是说增量式编码器只能告诉你“从刚才到现在走了多少”不能告诉你“你现在在哪儿”。这一点和绝对式编码器是本质区别。绝对式编码器内部有格雷码盘每个机械位置对应唯一的二进制码上电一读就是绝对位置不需要找零位。但绝对式编码器贵、线多很多行业项目里并不愿意为它掏钱所以增量式编码器依然是主流。既然用了增量式编码器就必须在上电以后想办法把“当前机械位置”这个信息补回来这就是零位校准存在的意义。1.2 零位偏差对FOC控制环路的实际影响FOC的核心在于坐标变换先把三相电流做Clarke变换得到αβ轴分量再做Park变换得到d/q轴分量。Park变换需要用到转子电角度。这个电角度如果错了整个坐标变换就错了。很多初次接触FOC的朋友以为编码器计数可以直接映射成电角度电角度机械角度×极对数。这句话本身没错但问题在于机械角度从哪儿算起。编码器的0计数点不一定对应A相绕组轴线的位置中间还隔着一个安装角。你从编码器读到的“机械角度”和定子坐标系里的“转子电角度”之间差了一个固定的偏移量。这个偏移量就是我们要校准的零位。零位不准会怎样拿id0控制来说如果控制器认为的电角度比真实电角度超前Δθ那么实际加在转子上的不是纯q轴电流而是混入了一部分d轴电流。结果就是你以为全在出力其实一部分电流变成了励磁或者去磁还有一部分做了无用功。我实测过一组数据Δθ在30°电角度时电机带同样负载需要的电流大约增加15%左右速度环和电流环开始明显抖动到90°电角度时q轴力矩分量直接降为0电机纹丝不动再继续偏到180°电机会出现反向制动给正指令反而往反方向使劲。所以零位校准做得准不准直接决定了FOC能不能出力、能不能稳定。这也是为什么我每次拿到一块新的电机板第一件事永远是校零位而不是先调PID。下面这张表能更直观地看出偏差对力矩的影响电角度偏差 Δθ实际输出力矩占比近似现象0°100%正常10°98.5%基本察觉不到30°86.6%带载性能下降60°50%明显无力、电流偏大90°0%完全不出力180°-100%反向制动可能反转2. 校准前的准备硬件确认与软件配置2.1 编码器接线、信号处理与方向校验在动手校零之前先把硬件底子打好。我用过不少编码器光电和磁的都有接线不外乎A、B、Z三根信号线加电源地线。但实际工程里最大的坑往往就在这三根线上。先说上拉。很多增量式编码器是开集电极输出必须外部接上拉电阻才能输出高电平。我一般取2.2kΩ到4.7kΩ上拉到编码器工作电压。上拉电阻太小信号沿变陡但耗电流增加太大边沿变缓高速时可能丢脉冲。2500线的光电编码器工作在几百转每分钟时一个脉冲周期也就几微秒边沿不够陡很容易被定时器误判。如果是长线传输或者现场干扰大建议直接用差分输出的编码器。A反、B反、Z反四对差分线抗干扰能力比单端强很多。我之前见过有人拿单端编码器穿过动力线电缆沟结果一跑电机就误触发Z脉冲位置跳变查了整整两天才发现是干扰问题。用STM32F103这类芯片做FOC也一样硬件上把编码器供电和电机供电分开走线电源引脚就近加104电容退耦能省去后面一大堆排查功夫。方向校验也别忽略。正常接线后手动正向转动电机转轴观察编码器计数器应该递增反方向应该递减。如果反了交换A/B两路或者在定时器配置里改成反向计数。别等到校完零位才发现方向反了那时候排查起来很头痛。如果你用CubeMX初始化编码器模式直接在TIM的Combined Channels里选Encoder Mode计数模式选Edge Aligned即可极性保持默认。2.2 编码器参数与极对数的换算关系零位校准最终要落到一个具体数值上当转子处于某一个已知电角度比如0°时编码器的计数是多少。这个计数和极对数、编码器线数直接相关先把这些参数算清楚后面才不会乱。举个例子。我手头这块电机极对数为4编码器是2500线。4倍频之后每转一圈计数器走2500×410000个数。一个电周期对应的机械角度是360°/490°在这个90°范围内编码器走10000/42500个数。也就是说如果零点偏了10个数对应电角度就偏了360°×10/10000×41.44°。这个量级对力矩影响很小所以工程上把零位精度做到1~2个编码器计数就完全够用了。软件上保存一个全局变量zero_count每次读编码器后先减掉zero_count再取模再映射到电角度。下面这段是我常用的角度换算函数用的是整数运算避免在控制中断里引入浮点延迟#define ENC_PPR 2500U // 编码器物理线数 #define ENC_COUNTS_1X (ENC_PPR * 4U) // 4倍频后单圈计数 #define MOTOR_POLE_PAIRS 4U // 电机极对数 static int32_t enc_zero_count 0; float get_elec_angle_deg(void) { int32_t count get_encoder_count(); int32_t mech_count count - enc_zero_count; if (mech_count 0) { mech_count ENC_COUNTS_1X; } // 机械角度放大10倍用整数表示 int32_t mech_angle_01deg mech_count * 3600 / ENC_COUNTS_1X; int32_t elec_angle_01deg (mech_angle_01deg * MOTOR_POLE_PAIRS) % 3600; return (float)elec_angle_01deg * 0.1f; }要注意机械角度模一圈等于10000电角度只要模360的整数倍即可。用整数运算算完之后再转浮点方便控制环使用。如果你用的是STM32定时器编码器模式默认计数器是16位的单圈计数如果超过65535就得开两个定时器级联或者用软件在溢出中断里扩展位宽。2500线4倍频是1000016位够用但如果换5000线编码器4倍频就是20000也没超不过要留意方向反转时的边界处理。3. 三种零位校准方法实操对比3.1 方法一开环电压矢量定位法最基础开环电压矢量定位法也叫直流定位法。原理很简单给电机施加一个固定方向的定子磁场转子会像一个指南针一样转到磁场指向的方向。具体操作分几步。第一确认电机空载或者轻载联轴器最好脱开避免负载带着转子跑偏。第二关断速度环和位置环只使能PWM输出和逆变器。第三给一组固定的占空比组合让合成电压矢量指向0°电角度方向。第四等待转子稳定一般500ms到1s。第五读取编码器计数器保存为zero_count。实际操作时我习惯把占空比限制在10%以内。比如Vbus是24V那输出的电压矢量幅值就压在2.4V左右。这个电压要能克服转子的齿槽转矩和摩擦转矩但又不能太大太大了转子会有过冲停下来也有误差。我测试过通直流定位后转子大概需要200ms到500ms才能完全稳定。你可以在代码里先等500ms然后连续读十次编码器计数如果前后一致再写成零位。这个方法优点是简单直接适合手头代码还不完整、电流环还没调通的时候用。缺点也很明显齿槽转矩会让转子卡在偏离磁场方向的位置逆变器死区也会让实际电压矢量方向偏几度。综合下来这个方法一般能做到±几度电角度的精度作为粗调够用如果后面要跑高速重载最好再用下面的方法精调一次。3.2 方法二电流闭环动态寻零法最推荐电流闭环动态寻零法是我在量产和调试项目里用得最多的方法。它不需要示波器不需要手转电机写一个函数就能自动完成校准精度还高。原理是这样的在电流环闭环的状态下给定id_ref0、iq_ref一个小电流再固定一个电角度指令θe_cmd。电机在力矩作用下会转动一直转到转子真实电角度θe等于θe_cmd的位置在这个位置电磁力矩为零转子会稳定停住。这时候读取编码器计数它对应的就是θeθe_cmd的机械角也就是零位。void zero_calibrate_encode(void) { // 1. 使能电流环id_ref0iq_ref取额定电流的20% set_id_ref(0.0f); set_iq_ref(0.2f * MOTOR_RATED_CURRENT); // 2. 固定电角度指令为0 set_elec_angle_cmd(0.0f); // 3. 等待转子稳定 HAL_Delay(800); // 4. 读取编码器计数器即为零位 enc_zero_count get_encoder_count(); // 5. 关断输出 disable_motor(); }注意几个细节iq_ref不要给太大给到0.2倍额定电流左右足够了。太大了转子转得快停下来的时候可能会过冲影响精度太小了克服不了摩擦转子会停在半路。我一般取0.1到0.3倍额定电流之间具体看电机大小和现场负载。还有一个提升精度的技巧做两次校准取平均。第一次用θe_cmd0°记录count_0第二次用θe_cmd180°记录count_180。理想情况下count_180应该比count_0多半个电周期对应的计数也就是(10000/4)/21250。如果实际差值和理论值不一致说明两次都存在同样的静摩擦误差取平均可以抵消一部分。具体做法是如果count_180count_0则校准后的zero_count(count_0 (count_180 - 1250))/2如果count_180count_0就把count_180先加一圈再算。这个操作实测能把零位精度从±3°电角度提高到±1°以内。另外如果电机是内置式永磁同步电机凸极效应会引入一个二倍频的磁阻转矩单纯用iq和θe_cmd定位会有一个固定的偏置角。处理方式有两种要么改用d轴电流定位法给定id_refI_ref、iq_ref0然后扫描θe_cmd观察转子在哪一个角度不动那个角度就是d轴方向要么根据磁阻模型做角度补偿。对于大多数表贴式电机用上面的方法已经足够。3.3 方法三霍尔信号辅助对齐法最快速如果你电机上已经有了霍尔传感器也可以用来辅助快速对齐。霍尔信号每60°电角度变一次所以它能把转子位置定位到一个60°扇区内。利用这个扇区信息我可以快速给出一个大致的电角度然后施加对应方向的电流矢量让转子对齐到扇区中心。步骤是这样的先读霍尔状态确定转子在哪个60°扇区。然后计算该扇区中心对应的电角度θ_center。接着给定id0、iq小电流、θe_cmdθ_center让转子转到扇区中心并停止。随后读取编码器计数作为粗零位。最后再用方法二精调一次。这个方法的好处是在带一定负载或者需要快速上电启动的场景下不用等转子长时间转动到位粗调几毫秒就完成。但霍尔定位精度只能到±30°电角度必须配合后续精调才能达到FOC的要求。我一般只在做无感切换或者上电起步阶段用霍尔粗定位真正跑控制还是以编码器零位为准。三种方法各有适用场景我整理成了一张对比表校准方法实现难度精度适用情况注意事项开环电压矢量定位低一般几度电角度误差空载/轻载快速粗调电流不能大防烧绕组电流闭环动态寻零中高可到1°以内空载适合出厂标定转子会转动不能带重载霍尔辅助对齐低较粗±30°内带霍尔、需要快速粗定位后续仍需精调4. 校准中常见问题与排查口诀4.1 校准结果时好时坏零位值跳变这是最让人抓狂的问题明明上电校了三次三次拿到的zero_count都不一样差得还不小。我遇到过的情况主要有三类。第一类Z信号毛刺或者共模干扰。Z信号每圈只有一个脉冲最容易受到噪声干扰。如果Z一毛刺就触发外部中断去清零计数器位置自然乱跳。解决手段硬件上给Z加RC低通比如100Ω串电阻加1nF对地电容软件上不要用上升沿直接清零可以用连续两次采样确认电平稳定后再处理。第二类校准电流太小或者供电不稳。校准电流托不住负载转子停在随机位置读数当然随机。看看母线电压是不是在抖动电机负载是不是忽大忽小。校准时最好空载用稳压源供电。第三类机械连接问题。联轴器打滑、顶丝松了编码器和电机轴之间有了相对转动这是硬伤。换一个联轴器重新锁紧就好。这个我印象特别深有一回校准值反复跳折腾了一晚上最后发现是编码器顶丝没拧紧。4.2 校准后电流大、力矩小甚至堵转如果校准流程跑完了zero_count也写进去了但电机还是没力主要查三件事。第一零点偏差过大。用方法一校准的话可能有几度到十几度的偏差。直接用方法二再校一次对比两次zero_count差多少如果差很多说明第一次确实偏了。第二编码器方向反了。方向不对电角度符号是反的FOC把坐标变换转成了“负反馈”。检查方式固定一个小iq给定一个小角度步进观察转子是不是往预期方向走。如果反了交换A/B或者软件取反。第三极对数填错。极对数写错是灾难级的特别是那种“极数”和“极对数”搞混的情况。12极电机的极对数是6不是12。填错之后电角度换算完全是错误的轻则电机抖动重则直接过流。用示波器看反电动势数过一个电周期里的过零次数就能准确得到极对数。4.3 校准完成后正常运行一段时间又乱跑校好好好跑的跑了几分钟突然失灵这种问题分两类一类是累计误差一类是单圈基准被破坏。累计误差的根源是增量式编码器没有绝对位置记忆长时间运行如果有些脉冲被干扰漏掉位置误差会越积越大。解决办法利用Z信号每圈到Z的时候把当前计数校正回预期值或者直接把计数器清零。Z信号在这里就是“每圈一次的位置锚点”。单圈基准被破坏比如Z信号本身受干扰或者初始化时Z沿被漏捕。我习惯在初始化里专门加一个“等待Z并校正zero_count”的流程让电机低速转一圈捕获Z信号触发点把zero_count修正为进入Z时记录的计数这样即使前面校的零位有一点偏差也能被Z信号拉回来。另外如果你用的是磁编码器温度漂移也可能导致位置缓慢漂移。这时候校准值只是“常温下的零位”温度变了就有偏移。工程上只能选温漂小的器件或者定期重新校准。这里也附上排查速查表方便对照现象可能原因处理办法零位值每次上电不一致校准电流太小、Z干扰、机械松动加大校准电流、滤波、紧固电流大、力矩小、抖动零位偏差大、方向反、极对数错重新精调、换向、确认极对数运行一段时间乱跑累计误差、Z基准被破坏、温漂用Z校正、加滤波、选低温漂器件5. 一点个人经验总结5.1 我的校准习惯上电自检 Flash记忆这几年调下来我觉得增量式编码器零位校准这件事最容易被忽略但其实最影响效果的就是一个字稳。电压要稳电流要稳转子停稳了再读数。很多看起来是控制算法的问题最后查来查去都是校准没做好。我现在的习惯是在初始化代码里内置一个自动寻零函数上电先跑一遍方法二校准值同时存到RAM和Flash。如果机械结构没动过下次上电直接读Flash里的zero_count用如果换过电机、拆过联轴器就重新校准。这样既保证了精度又兼顾了产线效率。5.2 别忽略低速抖动背后的真凶最后再分享一个小技巧如果校准之后低速运行还是有一顿一顿的感觉别急着反复校零位多半是电流采样噪声或者编码器线数不够导致的力矩波动。把采样滤波做好、编码器换高线数比你在零位上来回折腾有效得多。FOC这个东西很多时候问题不是出在算法本身而是出在“位置到底准不准”这个底层问题上。把零位校准这件事做扎实后面调参、跑高速、带负载都会顺畅很多。
增量式编码器零位校准：无刷电机FOC控制稳定运行的关键
如果你第一次把增量式编码器装到无刷电机上做FOC大概率会遇到这样的场景上电后给一个速度指令电机不是纹丝不动就是剧烈抖动电流还大得吓人。这时候先别急着调PID先把增量式编码器的零位校准做对。我在嵌入式电机控制的调试里踩过最多的坑就是电角度没有对齐导致电流环参数、速度环参数怎么调都白搭。这篇文章就把我在实际项目里用过的几种零位校准方法、踩过的坑和参数换算细节整理出来给正在调FOC的朋友一个参考。1. 为什么增量式编码器必须先校零位1.1 增量式编码器的天生缺陷上电不知道位置增量式编码器输出的是A、B、Z三路脉冲信号。A/B两相相位差90°用来测转向和位置增量Z相每转一圈只来一个窄脉冲作为机械零点参考。这套方案成本低、结构简单、响应快是中小功率无刷电机驱动器里最常见的反馈方式。但它有一个天生的缺陷它没有任何断电保存能力上电之后计数器只能从某个随机值开始累加你不知道当前转子到底在哪个机械角度上。也就是说增量式编码器只能告诉你“从刚才到现在走了多少”不能告诉你“你现在在哪儿”。这一点和绝对式编码器是本质区别。绝对式编码器内部有格雷码盘每个机械位置对应唯一的二进制码上电一读就是绝对位置不需要找零位。但绝对式编码器贵、线多很多行业项目里并不愿意为它掏钱所以增量式编码器依然是主流。既然用了增量式编码器就必须在上电以后想办法把“当前机械位置”这个信息补回来这就是零位校准存在的意义。1.2 零位偏差对FOC控制环路的实际影响FOC的核心在于坐标变换先把三相电流做Clarke变换得到αβ轴分量再做Park变换得到d/q轴分量。Park变换需要用到转子电角度。这个电角度如果错了整个坐标变换就错了。很多初次接触FOC的朋友以为编码器计数可以直接映射成电角度电角度机械角度×极对数。这句话本身没错但问题在于机械角度从哪儿算起。编码器的0计数点不一定对应A相绕组轴线的位置中间还隔着一个安装角。你从编码器读到的“机械角度”和定子坐标系里的“转子电角度”之间差了一个固定的偏移量。这个偏移量就是我们要校准的零位。零位不准会怎样拿id0控制来说如果控制器认为的电角度比真实电角度超前Δθ那么实际加在转子上的不是纯q轴电流而是混入了一部分d轴电流。结果就是你以为全在出力其实一部分电流变成了励磁或者去磁还有一部分做了无用功。我实测过一组数据Δθ在30°电角度时电机带同样负载需要的电流大约增加15%左右速度环和电流环开始明显抖动到90°电角度时q轴力矩分量直接降为0电机纹丝不动再继续偏到180°电机会出现反向制动给正指令反而往反方向使劲。所以零位校准做得准不准直接决定了FOC能不能出力、能不能稳定。这也是为什么我每次拿到一块新的电机板第一件事永远是校零位而不是先调PID。下面这张表能更直观地看出偏差对力矩的影响电角度偏差 Δθ实际输出力矩占比近似现象0°100%正常10°98.5%基本察觉不到30°86.6%带载性能下降60°50%明显无力、电流偏大90°0%完全不出力180°-100%反向制动可能反转2. 校准前的准备硬件确认与软件配置2.1 编码器接线、信号处理与方向校验在动手校零之前先把硬件底子打好。我用过不少编码器光电和磁的都有接线不外乎A、B、Z三根信号线加电源地线。但实际工程里最大的坑往往就在这三根线上。先说上拉。很多增量式编码器是开集电极输出必须外部接上拉电阻才能输出高电平。我一般取2.2kΩ到4.7kΩ上拉到编码器工作电压。上拉电阻太小信号沿变陡但耗电流增加太大边沿变缓高速时可能丢脉冲。2500线的光电编码器工作在几百转每分钟时一个脉冲周期也就几微秒边沿不够陡很容易被定时器误判。如果是长线传输或者现场干扰大建议直接用差分输出的编码器。A反、B反、Z反四对差分线抗干扰能力比单端强很多。我之前见过有人拿单端编码器穿过动力线电缆沟结果一跑电机就误触发Z脉冲位置跳变查了整整两天才发现是干扰问题。用STM32F103这类芯片做FOC也一样硬件上把编码器供电和电机供电分开走线电源引脚就近加104电容退耦能省去后面一大堆排查功夫。方向校验也别忽略。正常接线后手动正向转动电机转轴观察编码器计数器应该递增反方向应该递减。如果反了交换A/B两路或者在定时器配置里改成反向计数。别等到校完零位才发现方向反了那时候排查起来很头痛。如果你用CubeMX初始化编码器模式直接在TIM的Combined Channels里选Encoder Mode计数模式选Edge Aligned即可极性保持默认。2.2 编码器参数与极对数的换算关系零位校准最终要落到一个具体数值上当转子处于某一个已知电角度比如0°时编码器的计数是多少。这个计数和极对数、编码器线数直接相关先把这些参数算清楚后面才不会乱。举个例子。我手头这块电机极对数为4编码器是2500线。4倍频之后每转一圈计数器走2500×410000个数。一个电周期对应的机械角度是360°/490°在这个90°范围内编码器走10000/42500个数。也就是说如果零点偏了10个数对应电角度就偏了360°×10/10000×41.44°。这个量级对力矩影响很小所以工程上把零位精度做到1~2个编码器计数就完全够用了。软件上保存一个全局变量zero_count每次读编码器后先减掉zero_count再取模再映射到电角度。下面这段是我常用的角度换算函数用的是整数运算避免在控制中断里引入浮点延迟#define ENC_PPR 2500U // 编码器物理线数 #define ENC_COUNTS_1X (ENC_PPR * 4U) // 4倍频后单圈计数 #define MOTOR_POLE_PAIRS 4U // 电机极对数 static int32_t enc_zero_count 0; float get_elec_angle_deg(void) { int32_t count get_encoder_count(); int32_t mech_count count - enc_zero_count; if (mech_count 0) { mech_count ENC_COUNTS_1X; } // 机械角度放大10倍用整数表示 int32_t mech_angle_01deg mech_count * 3600 / ENC_COUNTS_1X; int32_t elec_angle_01deg (mech_angle_01deg * MOTOR_POLE_PAIRS) % 3600; return (float)elec_angle_01deg * 0.1f; }要注意机械角度模一圈等于10000电角度只要模360的整数倍即可。用整数运算算完之后再转浮点方便控制环使用。如果你用的是STM32定时器编码器模式默认计数器是16位的单圈计数如果超过65535就得开两个定时器级联或者用软件在溢出中断里扩展位宽。2500线4倍频是1000016位够用但如果换5000线编码器4倍频就是20000也没超不过要留意方向反转时的边界处理。3. 三种零位校准方法实操对比3.1 方法一开环电压矢量定位法最基础开环电压矢量定位法也叫直流定位法。原理很简单给电机施加一个固定方向的定子磁场转子会像一个指南针一样转到磁场指向的方向。具体操作分几步。第一确认电机空载或者轻载联轴器最好脱开避免负载带着转子跑偏。第二关断速度环和位置环只使能PWM输出和逆变器。第三给一组固定的占空比组合让合成电压矢量指向0°电角度方向。第四等待转子稳定一般500ms到1s。第五读取编码器计数器保存为zero_count。实际操作时我习惯把占空比限制在10%以内。比如Vbus是24V那输出的电压矢量幅值就压在2.4V左右。这个电压要能克服转子的齿槽转矩和摩擦转矩但又不能太大太大了转子会有过冲停下来也有误差。我测试过通直流定位后转子大概需要200ms到500ms才能完全稳定。你可以在代码里先等500ms然后连续读十次编码器计数如果前后一致再写成零位。这个方法优点是简单直接适合手头代码还不完整、电流环还没调通的时候用。缺点也很明显齿槽转矩会让转子卡在偏离磁场方向的位置逆变器死区也会让实际电压矢量方向偏几度。综合下来这个方法一般能做到±几度电角度的精度作为粗调够用如果后面要跑高速重载最好再用下面的方法精调一次。3.2 方法二电流闭环动态寻零法最推荐电流闭环动态寻零法是我在量产和调试项目里用得最多的方法。它不需要示波器不需要手转电机写一个函数就能自动完成校准精度还高。原理是这样的在电流环闭环的状态下给定id_ref0、iq_ref一个小电流再固定一个电角度指令θe_cmd。电机在力矩作用下会转动一直转到转子真实电角度θe等于θe_cmd的位置在这个位置电磁力矩为零转子会稳定停住。这时候读取编码器计数它对应的就是θeθe_cmd的机械角也就是零位。void zero_calibrate_encode(void) { // 1. 使能电流环id_ref0iq_ref取额定电流的20% set_id_ref(0.0f); set_iq_ref(0.2f * MOTOR_RATED_CURRENT); // 2. 固定电角度指令为0 set_elec_angle_cmd(0.0f); // 3. 等待转子稳定 HAL_Delay(800); // 4. 读取编码器计数器即为零位 enc_zero_count get_encoder_count(); // 5. 关断输出 disable_motor(); }注意几个细节iq_ref不要给太大给到0.2倍额定电流左右足够了。太大了转子转得快停下来的时候可能会过冲影响精度太小了克服不了摩擦转子会停在半路。我一般取0.1到0.3倍额定电流之间具体看电机大小和现场负载。还有一个提升精度的技巧做两次校准取平均。第一次用θe_cmd0°记录count_0第二次用θe_cmd180°记录count_180。理想情况下count_180应该比count_0多半个电周期对应的计数也就是(10000/4)/21250。如果实际差值和理论值不一致说明两次都存在同样的静摩擦误差取平均可以抵消一部分。具体做法是如果count_180count_0则校准后的zero_count(count_0 (count_180 - 1250))/2如果count_180count_0就把count_180先加一圈再算。这个操作实测能把零位精度从±3°电角度提高到±1°以内。另外如果电机是内置式永磁同步电机凸极效应会引入一个二倍频的磁阻转矩单纯用iq和θe_cmd定位会有一个固定的偏置角。处理方式有两种要么改用d轴电流定位法给定id_refI_ref、iq_ref0然后扫描θe_cmd观察转子在哪一个角度不动那个角度就是d轴方向要么根据磁阻模型做角度补偿。对于大多数表贴式电机用上面的方法已经足够。3.3 方法三霍尔信号辅助对齐法最快速如果你电机上已经有了霍尔传感器也可以用来辅助快速对齐。霍尔信号每60°电角度变一次所以它能把转子位置定位到一个60°扇区内。利用这个扇区信息我可以快速给出一个大致的电角度然后施加对应方向的电流矢量让转子对齐到扇区中心。步骤是这样的先读霍尔状态确定转子在哪个60°扇区。然后计算该扇区中心对应的电角度θ_center。接着给定id0、iq小电流、θe_cmdθ_center让转子转到扇区中心并停止。随后读取编码器计数作为粗零位。最后再用方法二精调一次。这个方法的好处是在带一定负载或者需要快速上电启动的场景下不用等转子长时间转动到位粗调几毫秒就完成。但霍尔定位精度只能到±30°电角度必须配合后续精调才能达到FOC的要求。我一般只在做无感切换或者上电起步阶段用霍尔粗定位真正跑控制还是以编码器零位为准。三种方法各有适用场景我整理成了一张对比表校准方法实现难度精度适用情况注意事项开环电压矢量定位低一般几度电角度误差空载/轻载快速粗调电流不能大防烧绕组电流闭环动态寻零中高可到1°以内空载适合出厂标定转子会转动不能带重载霍尔辅助对齐低较粗±30°内带霍尔、需要快速粗定位后续仍需精调4. 校准中常见问题与排查口诀4.1 校准结果时好时坏零位值跳变这是最让人抓狂的问题明明上电校了三次三次拿到的zero_count都不一样差得还不小。我遇到过的情况主要有三类。第一类Z信号毛刺或者共模干扰。Z信号每圈只有一个脉冲最容易受到噪声干扰。如果Z一毛刺就触发外部中断去清零计数器位置自然乱跳。解决手段硬件上给Z加RC低通比如100Ω串电阻加1nF对地电容软件上不要用上升沿直接清零可以用连续两次采样确认电平稳定后再处理。第二类校准电流太小或者供电不稳。校准电流托不住负载转子停在随机位置读数当然随机。看看母线电压是不是在抖动电机负载是不是忽大忽小。校准时最好空载用稳压源供电。第三类机械连接问题。联轴器打滑、顶丝松了编码器和电机轴之间有了相对转动这是硬伤。换一个联轴器重新锁紧就好。这个我印象特别深有一回校准值反复跳折腾了一晚上最后发现是编码器顶丝没拧紧。4.2 校准后电流大、力矩小甚至堵转如果校准流程跑完了zero_count也写进去了但电机还是没力主要查三件事。第一零点偏差过大。用方法一校准的话可能有几度到十几度的偏差。直接用方法二再校一次对比两次zero_count差多少如果差很多说明第一次确实偏了。第二编码器方向反了。方向不对电角度符号是反的FOC把坐标变换转成了“负反馈”。检查方式固定一个小iq给定一个小角度步进观察转子是不是往预期方向走。如果反了交换A/B或者软件取反。第三极对数填错。极对数写错是灾难级的特别是那种“极数”和“极对数”搞混的情况。12极电机的极对数是6不是12。填错之后电角度换算完全是错误的轻则电机抖动重则直接过流。用示波器看反电动势数过一个电周期里的过零次数就能准确得到极对数。4.3 校准完成后正常运行一段时间又乱跑校好好好跑的跑了几分钟突然失灵这种问题分两类一类是累计误差一类是单圈基准被破坏。累计误差的根源是增量式编码器没有绝对位置记忆长时间运行如果有些脉冲被干扰漏掉位置误差会越积越大。解决办法利用Z信号每圈到Z的时候把当前计数校正回预期值或者直接把计数器清零。Z信号在这里就是“每圈一次的位置锚点”。单圈基准被破坏比如Z信号本身受干扰或者初始化时Z沿被漏捕。我习惯在初始化里专门加一个“等待Z并校正zero_count”的流程让电机低速转一圈捕获Z信号触发点把zero_count修正为进入Z时记录的计数这样即使前面校的零位有一点偏差也能被Z信号拉回来。另外如果你用的是磁编码器温度漂移也可能导致位置缓慢漂移。这时候校准值只是“常温下的零位”温度变了就有偏移。工程上只能选温漂小的器件或者定期重新校准。这里也附上排查速查表方便对照现象可能原因处理办法零位值每次上电不一致校准电流太小、Z干扰、机械松动加大校准电流、滤波、紧固电流大、力矩小、抖动零位偏差大、方向反、极对数错重新精调、换向、确认极对数运行一段时间乱跑累计误差、Z基准被破坏、温漂用Z校正、加滤波、选低温漂器件5. 一点个人经验总结5.1 我的校准习惯上电自检 Flash记忆这几年调下来我觉得增量式编码器零位校准这件事最容易被忽略但其实最影响效果的就是一个字稳。电压要稳电流要稳转子停稳了再读数。很多看起来是控制算法的问题最后查来查去都是校准没做好。我现在的习惯是在初始化代码里内置一个自动寻零函数上电先跑一遍方法二校准值同时存到RAM和Flash。如果机械结构没动过下次上电直接读Flash里的zero_count用如果换过电机、拆过联轴器就重新校准。这样既保证了精度又兼顾了产线效率。5.2 别忽略低速抖动背后的真凶最后再分享一个小技巧如果校准之后低速运行还是有一顿一顿的感觉别急着反复校零位多半是电流采样噪声或者编码器线数不够导致的力矩波动。把采样滤波做好、编码器换高线数比你在零位上来回折腾有效得多。FOC这个东西很多时候问题不是出在算法本身而是出在“位置到底准不准”这个底层问题上。把零位校准这件事做扎实后面调参、跑高速、带负载都会顺畅很多。
