PMSM脉冲注入初始位置检测：原理、C代码与现场调试

伺服项目如果要上无感FOC，或者增量编码器第一次上电没有绝对零位，第一个硬门槛就是：电机静止状态下，转子到底在哪个电角度。这个位置拿不准，后面电流环就算调得再快，上电一瞬间也可能抖动、反转甚至过流，换成高精度应用场合，这个问题只会被放大得更严重。PMSM脉冲注入初始位置检测，就是在这种背景下被反复用到的一类方案。它不依赖编码器绝对位置，也不需要让电机先转起来，只在静止状态下向定子绕组打几个电压脉冲，通过电流响应反推出转子磁极方向。最近我把这套程序固化成C代码，配套写了一份解析文档，实际跑过多台不同规格的电机，也踩了不少文档里不会细写的坑。这篇文不打算复刻那份文档，而是把原理、算法流程、C代码模块划分、参数计算和现场调试经验串起来聊一遍，给正准备动手搭这套程序的人一份可落地的参考。

1. 为什么高精度场合偏偏绕不开初始位置检测

1.1 上电瞬间的电角度是个“看不见的基准”

FOC运行时，所有坐标变换都建立在转子磁极方向的坐标轴上。如果这个方向估错了，id、iq的解耦就是错的，转矩输出也跟着偏。带增量编码器的伺服系统第一次上电，没有任何办法知道电机轴当前停在哪个位置，除非先做一次找零操作。很多项目嫌找零麻烦，或者负载结构不允许电机在找零过程中乱动，就只能靠初始位置检测算法在静止状态下估算出这个基准角度。

高精度场合对初始位置检测提出了更苛刻的要求，不只是“大概知道在哪个扇区”，而是期望误差控制在几度电角度以内。因为初始角度误差一旦偏大，电机会带载起动，可能发生短时失步。尤其是一些需要低速大转矩起动的设备，角度误差造成的电流浪费和发热会非常明显。这也是我为什么会在项目里选脉冲注入，而不是单纯用一个预定位电压把转子“吸”到已知位置。

1.2 三个常见方案里，脉冲注入为什么更适合

行业内做初始位置检测，主流思路无非三类：预定位、高频注入、脉冲注入。

预定位操作上最直接，给定一个固定电压矢量，持续一段时间，让转子被定子磁场拖到与该矢量对齐的位置。这个方法的问题在于，转子转动必然带动负载，有些机构根本不允许静止状态下发生位移；另外，如果负载侧有外力，转子可能拖不到指定位置，甚至停在不稳定平衡点附近。某些应用里可以用反复通断电的方式来解决，但高精度场合对执行机构位移限制很严格，预定位经常直接被否决。

高频注入法精度好，尤其适合低速运行，但实现复杂。它需要注入高频正弦信号，再经过带通滤波、幅值解调、反正切或者锁相环来提取位置误差信号。调试周期长，对电流采样带宽和信号处理资源要求也更高。对很多以单片机为核心的伺服方案来说，这并不划算。

脉冲注入的定位思路介于两者之间。它不主动让转子转动，而是用短促的电压脉冲在静止电机上建立磁链，通过不同方向下电流上升速率的差异来辨识转子磁极轴。整个过程通常持续几毫秒到几十毫秒，转子基本不发生位移，实现逻辑也简单，用状态机加定时器就能跑。只要电流采样和PWM定时配合得当，精度可以做到满足大多数伺服场合的要求。它的缺点也很明确，只能在静止状态做，电机一旦转起来就无法继续使用，所以它和运行阶段的转子位置观测是前后衔接的关系，而不是替代关系。

2. 脉冲注入检测的原理拆解：从电感差异到最终角度

2.1 转子凸极效应和磁饱和带来的电感差异

理解脉冲注入，先要理解一个关键物理量：相绕组电感为什么会随转子位置变化。

永磁同步电机的定子电感在d轴和q轴上并不相同，内嵌式电机尤其明显，q轴磁路因为转子内部结构导致气隙更大，电感比d轴大很多。这类电机天然存在凸极效应，电感随转子位置呈周期性变化，每180度电角度重复一次。表面贴装电机虽然凸极率更弱，但电枢反应会造成磁路饱和，永磁体的磁通方向会影响定子绕组的等效电感。当外加磁动势方向与永磁体磁通方向一致时，磁路更接近饱和，等效电感变小；方向相反时，电感变大。这种饱和效应就是区分N/S极的依据。

我一开始以为这个电感差异会很明显，测出来才发现，有些弱凸极电机在六个基本电压矢量方向上的电流差异可能只有百分之几到百分之十几。如果电流采样精度不够，或者ADC噪声偏大，很容易被淹没。所以在高精度方案里，电流采样通道的零漂校准和多次采样求平均就变得特别重要，这部分我在后面调试章节会展开。

2.2 一记电压脉冲下去，电流为什么能反映位置

脉冲注入的核心是施加短时电压矢量，然后观测电流响应。根据电气时间常数，电流上升率大约满足：

di/dt ≈ (V_inj - EMF) / L

电机静止时反电动势为零，电流上升率主要由电压和电感决定。对同一个电压矢量幅值来说，电感越小，电流峰值越高，上升也越快；电感越大，电流峰值越低。依次在多个方向上打脉冲，就能测出“哪个方向电感最小、哪个方向电感最大”。

实际操作里，我之前惯用六个基本电压矢量方向作为初步扫描。每两个方向相差60度电角度，覆盖整个圆周。对一个固定方向的某个转子位置，六个方向上的电感分布会呈现一个余弦状的变化趋势，电感最小值对应的方向，就是转子d轴方向所在的区域。这里有个细节需要注意：单纯找到最小电感方向只是找到了d轴的轴线，但还存在180度的电角度模糊，也就是可能找到的是N极方向，也可能是S极方向，必须再通过磁极极性判断才能确定。

这六个脉冲方向，我通常把角度定成0度、60度、120度、180度、240度、300度，对应到三相桥臂就是U相正、UV相间、V相正、VW相间等八个开关组合里的六个非零矢量。为了让电流有足够明显的差异，脉冲宽度不能太短，但也不能太长。太短了电流还没建立起来ADC根本测不到；太长了会导致转子轻微移动，甚至触发过流保护。具体宽度怎么定，需要结合母线和电感参数算，后面会专门说。

2.3 N/S极判断：反向脉冲解决最后180度模糊

找到d轴方向后，需要在180度的不确定性里挑出真正的磁极方向。办法就是在这个轴线方向上分别施加正向和反向两个电压脉冲，比较两次电流响应。

当外加电流产生的磁场与转子永磁磁场方向一致时，磁路饱和加剧，等效电感小，峰值电流大；方向相反时，等效电感大，峰值电流小。所以两个脉冲中，电流响应更大的一次，对应的是退磁方向还是增磁方向，需要结合d轴正方向定义来定。通常我们约定，让电机产生正力矩时对应d轴正方向的电压脉冲，那么电流峰值更大的方向就是该方向所处的磁极。实际代码里，我会在比较前先做一次ADC零点校准，尽量避免电流传感器零漂对结果方向的误导。

由于这种饱和不对称性相对较弱，我一般会在这个环节连续重复打两到三次脉冲，取平均值再比较。如果电机完全静止，这么做的时间成本也不高，换来的是更稳定的极性判断。需要注意的是，电机静止但负载有偏心负载力矩时，转子在脉冲冲击下可能会有极微小转动，造成N/S判断误判。这种情况我会在最终角度上做迟滞处理，比如把结果锁定后，再给控制层一个检测完成标志，确保启动前手段不再变化。

3. C代码工程化落地：状态机到底该写几行

3.1 我建议的代码模块划分

拿到一份C代码，先别看函数细节，应该先看模块划分。我把整套检测逻辑拆成四块：调度模块、矢量表模块、ADC结果处理模块、角度解算输出模块。

调度模块用状态机管理，负责“开始检测”、“依次注入脉冲”、“等待ADC完成”、“切换矢量”、“计算角度”、“完结”这一整条链路。矢量表模块维护六个基本电压矢量的PWM占空比配置，以及对应的极性标记。ADC结果处理模块负责把采样值从原始码值转换成可比较的电流值，并做均值滤波和零点校正。角度解算输出模块在拿到六个方向的电流统计后，先搜索最小电感方向，再执行反向脉冲比较，最后输出电角度。

这样拆的好处是方便调试。状态机卡在哪一步，直接看状态枚举就能定位；角度算得不对，可以单独把中间表的数据打印出来分析，不至于为了看一个变量把整个控制环路翻一遍。

代码结构大致是这样：

typedef enum { DET_IDLE, DET_START, DET_SET_VECTOR, DET_WAIT_ADC, DET_NEXT_VECTOR, DET_POLE_CHECK, DET_CALC_ANGLE, DET_DONE } DetState; static DetState det_state; static uint8_t vector_index; static int32_t current_table[6]; static int32_t pole_current_pos; static int32_t pole_current_neg;

3.2 六矢量扫描的关键C代码段

为了把思路说透，我简化了实际代码，保留最核心的部分。首先是六个非零基本电压矢量的配置表。这里用占空比千分比为例，方便不同母线电压下移植：

/* 六路基本电压矢量，占空比单位 0.1%，假定斩波频率固定 */ static const int16_t vector_table[6][3] = { { 100, -50, -50 }, /* 0度 U正，V负，W负 */ { 50, 50, -100 }, /* 60度 U正，V正，W负 */ { -50, 100, -50 }, /* 120度 V正 */ { -100, 50, 50 }, /* 180度 */ { -50, -50, 100 }, /* 240度 */ { 50, -100, 50 } /* 300度 */ };

严格说，这个表里有些方向不是标准等幅矢量，但作为位置扫描足够了。工程上我更倾向于让每个方向上的合成电压幅值保持一致，所有负半桥占空比统一用负值来表达方向，避免某些方向上电流幅值天然偏大造成误判。

注入函数要做的事很明确：设置PWM比较值，同步触发ADC采样，等待转换完成标志。典型的实现会放在定时器中断服务函数外，否则一次检测就要占用很长时间的主循环：

void det_set_vector(uint8_t idx) { pwm_set_duty(vector_table[idx][0], vector_table[idx][1], vector_table[idx][2]); adc_trigger_by_pwm(); } uint8_t det_wait_complete(uint32_t timeout_ms) { uint32_t t0 = get_tick(); while ((adc_done_flag == 0) && (get_tick() - t0 < timeout_ms)) { /* 等待 */ } return (adc_done_flag != 0); }

3.3 角度解算代码与180度消歧逻辑

六个方向的电流都拿到后，先做一遍排序，找最小电流方向，也就是最大电感方向的反向，或者最大电流方向，这个可以依据检测表里的定义统一。我习惯找最大电流方向，因为电流峰值的信噪比通常比谷值高。找到最大电流方向后，需要检查其对称的相反方向，因为六个基本矢量的间隔是60度，若最大值出现在0度，那180度也在扫描范围内，可以直接取表里对应的索引。然后分别在这两个方向上做反向极性判断，比较两个方向的电流响应。

伪代码思路就是：

static int32_t scan_min_angle(void) { uint8_t idx_max = 0; for (uint8_t i = 1; i < 6; i++) { if (current_table[i] > current_table[idx_max]) { idx_max = i; } } return (int32_t)idx_max * 60; } static uint8_t judge_pole(int32_t angle) { int32_t i_pos = inject_pulse(angle); int32_t i_neg = inject_pulse(angle + 180); return (i_pos > i_neg) ? 1 : 0; }

最终的电角度就是扫描角加180度校正后的结果。这里有个工程小技巧，如果电机极对数大于1，输出的电角度还需要通过极对数映射成机械角度吗？不一定。FOC需要的是电角度，而驱动器显示的位置值才需要机械角度。所以初始位置检测函数直接输出电角度即可，后续编码器零标定也是以这个电角度为参考。

4. 实测调试：波形、干扰、常见问题速查

4.1 现场波形怎么看：电流响应和阈值

把这套代码跑起来之后，第一步是观察电流波形。示波器电流探头夹在某一相上，让检测程序自动运行，会看到一串脉冲宽度相同的窄电流脉冲波。每个脉冲的峰值高度应该随方向不同出现有规律的高低变化。如果六次脉冲峰值完全一样，基本就是两个原因：要么电机凸极率太低，要么脉冲宽度太短，电流还没建立起来，ADC没有捕捉到差异。

我调试时看波形重点关注三点。第一，电流峰值是否接近预期值，比如我设的目标峰值是额定电流的20%左右，如果差太多，需要调脉宽。第二，脉冲顶部是否平直，若不平直说明采样时刻可能落在开关噪声区，需要调整ADC采样相对PWM的延迟。第三，脉冲之间是否出现缓慢的偏置漂移，如果漂移明显，先查母线电压和电流采样通道，再考虑零漂补偿。

4.2 干扰与异常波形的识别

有次在车间现场，检测结果偶尔会从正常角度跳到相邻扇区，示波器看波形又看不出明显毛刺。后来查下来是被测电机旁边有一台变频器在运行，脉冲注入的频率和变频器载波产生了拍频干扰。这种干扰很难完全靠C代码里的均值滤波滤掉，最终方案是在检测流程开始前加一个短延时，专门等干扰源过完一个工频周波后开始检测，同时把六个方向的电流采样都改为连续三次取中值。

另外一类常见异常是，电流波形看起来正常，但角度结果重复性很差。这种情况往往是转子在脉冲作用下发生了微动。微动在空载小惯量电机上更明显，因为只要外力绕过了静摩擦力矩，转子就会沿着脉冲作用方向偏转几度。解决思路是缩短脉宽，或者把脉宽分段，中间加一个短零矢量让电流回零，防止磁链累积把转子拖走。

4.3 常见问题排查速查表

5. README里没写但你必须知道的细节

5.1 电流采样零漂校准：高精度项目的起跑线

脉冲注入最终比较的是电流差，电流采样通道哪怕只有毫安级零漂，也可能在百分几的差异中被放大成错误的扇区判断。所以我建议把零漂校准放在检测流程最开始，也就是注入第一个脉冲之前。先关断所有桥臂，读取三路电流采样值各几十次，求平均后作为零漂值保存。比较电流前，把每个ADC结果都减去这个零漂值。这一步听起来简单，但很多人在高精度场合精度上不去，问题往往就出在这里。

电流采样还要注意反馈通道的带宽。如果设计中使用低通滤波器滤掉了PWM开关纹波，同时也会把脉冲电流的上升沿削平。脉冲检测需要的是快速变化的梯形波峰值，滤波器时间常数不能太大。我常用的经验是把电流反馈低通截至频率放在PWM载波频率的1/5到1/10之间，既能滤掉开关纹波，又不至于把脉冲响应拖得面目全非。

5.2 参数计算：脉宽、电压、阈值的自洽

脉宽和电压不能随便拍脑袋。简单估算方法如下：目标峰值电流设为I_peak，母线电压为Vdc，绕组等效电感最小值L_min，脉宽T_on大约满足 I_peak ≈ Vdc * T_on / L_min。如果电机是24V母线，L_min约1mH，想要得到2A峰值电流，T_on大约需要83微秒。如果PWM频率是10kHz，占空比最大能到0.5，T_on就接近一个开关周期的一半，这个组合是可行的。

如果Por是在300微秒以上的脉宽，就必须留意转子会不会被拖动。一般的工程经验是，脉宽尽量控制在额定电流建立所需时间的2倍以内，并且总检测时间控制在50毫秒以内。即便这样做了，高速响应和重负载场合也要额外验证。电流阈值设置方面，我习惯把有效响应阈值设在电源噪声峰峰值的3倍以上，太低就会把噪声当成信号。

5.3 从初始位置检测到平滑起动的衔接

检测完成并不等于程序结束，后面还要把检测到的角度交给FOC控制环。不少人在这个衔接点翻车：检测得到了角度，但FOC起动瞬间还是抖了一下。原因通常是检测结果和实际电流环的初始值之间有一个积分器状态不一致的问题。建议在检测完成后，先保持转矩电流指令为零，只建立磁链，让电流环先收敛到零状态，再根据应用需要给速度或位置指令。

另一个衔接细节是，脉冲注入检测结果覆盖的只是电角度，对带增量编码器的系统，检测后需要把这个角度写入编码器位置计数器作为初始零位。这个过程叫编码器零位初始化。如果漏了这一步，电机转起来后，角度会从固定初始值开始累积，但实际转子位置和它之间总差一个偏置，系统仍然会失控。

6. 我在实际项目中沉淀的一点小经验

脉冲注入方案看起来不复杂，真正做高精度项目时，耐心比聪明重要。第一次跑通只是开始，角度重复性和干扰鲁棒性，才是高精度应用真正考核的硬指标。我建议在做正式验证前，先把电机固定在一个分度装置上，人为转动到几十个不同位置，然后让检测程序自动重复几十轮，统计角度误差分布。如果检测结果像云图一样散开，那就先别急着改算法，先把电源、采样、脉宽这三项抠干净。

还有一点值得提醒：不要总想着用一个方向表覆盖所有电机。不同电机专业的凸极率、饱和深度、电感绝对值差异非常大，换电机后至少要把脉宽和判定阈值重新标定一遍。代码里最好做成参数宏定义，方便在维护文档时同步修改。实际上，我把这套C程序和解析文档归档时，花了很多时间在“如何快速换型调试”上，现在换电机只需要改几个参数，再用测试脚本跑一遍离线标定即可。

这套检测方法后续还可以往两个方向扩展：一种是把它从纯粹的开环脉冲注入改成闭环保压调节，根据当前电流响应动态调整下一个脉冲的宽度，这样对宽范围电感电机都能自适应；另一种是把检测结果作为位置观测器的初始状态，接续低速下的高频注入，实现从零速到高速的完整无感起动链。两种思路我都试过，前者代码量更少，后者系统鲁棒性更强，取舍完全看应用场合的侧重点。如果你们项目也需要在静止状态下拿到可靠的电角度，希望这些实测经验能帮你少走几十个工时的弯路。