伺服驱动器上电的那一瞬，MCU面对的第一个问题不是PI参数整定，而是：电机的转子现在朝哪个方向。这个问题答错了，后面的一切都是白做——矢量控制的电流方向会错、力矩方向会反、严重时直接飞车或堵转。尤其在高精度场合，比如机械臂关节、激光切割随动系统、数控转台，上电后就要给出可靠的转子初始角度，不能靠人工盘车，更不能靠碰运气。
这篇文章要分享的就是一种在静止状态下检测PMSM转子初始位置的方法：脉冲注入法，配合我手写的C代码和完整解析文档。它的核心思想是：往定子绕组里打几个方向已知的电压脉冲，然后通过电流响应幅度来反推转子磁极在静止坐标系里的朝向。适合做伺服驱动、无感FOC控制、云端调试工具链的嵌入式工程师来参考，也适合刚接触永磁电机控制、想知道"初始位置检测到底怎么实现"的同学做源码级拆解。
1. 转子初始位置未知的后果：为什么上电瞬间不能直接跑
很多刚开始做FOC的朋友都有过类似的疑惑：反正闭环里有编码器或者观测器，上电之后让观测器跑起来不就行了？何必非要在静止状态下单独做一次初始位置检测？
这个想法在电机已经转动的情况下没问题，但在上电瞬间完全是另一回事。电机静止时，反电动势为零，基于反电动势的观测器没有任何有效输入，估算出来的角度就是一团乱码。如果你强行用这一团乱码去启动电流环，等效于把电压矢量打向一个错误的方向，转子可能瞬时猛抽一下，轻则抖动，重则把机械结构顶坏。所以，伺服系统要想丝滑起步，第一步必须先解决"初始角度是多少"这个基础问题。
再说一个更隐蔽的场景：即便是带编码器的伺服系统，如果编码器是增量式的，上电时也只能知道角度变化量，不知道绝对位置。有些驱动器会在上电时通过编码器Z脉冲来寻零，但机械结构不一定允许电机在寻零过程中大幅转动，或者应用本身要求电机不动。于是脉冲注入法就派上用场了——它能够在转子保持锁死（或者极低速蠕动）的状态下，仅仅通过加电压、测电流，就估计出转子磁极在静止坐标系中的方向。
脉冲注入法解决的核心矛盾是：在转子不转动、没有反电动势、也没有外部位置传感器的情况下，怎么从电气信号里挖出转子角度。它不依赖电机是否带编码器、不依赖机械抱闸是否可靠、也不要求你手动盘车到某个已知位置，只需要利用绕组电感随转子角度的变化特性，就能把位置信息"读"出来。
这里顺带说明一个适用边界：脉冲注入法要求电机处于静止或准静止状态，允许的残余转动速度通常很低（比如转速小于额定转速的1%）。如果电机正在以较高速度转动，就直接切到基于反电动势的观测器，没有必要做脉冲注入。这一点在工作文档里一定要写清楚，否则后边调试会出现"检测结果乱跳"的奇怪现象。
2. 脉冲注入法的核心机制：从电感饱和到位置映射
要理解脉冲注入法，得先从PMSM的定子电感说起。永磁同步电机的转子是永磁体，它会使得磁路在某个方向上的饱和度比其他方向更高。永磁体磁链方向，也就是d轴方向，磁路往往更容易饱和。电感是磁链对电流的变化率，磁路越饱和，电感越小。所以，当我们往定子绕组不同方向施加同样大小的电压脉冲时，电流的上升速度会不一样：电感小的方向电流上升快，在同样的脉冲宽度下电流峰值更高。
对于内置式PMSM（IPMSM），d轴电感Ld和q轴电感Lq本身就不相等，通常Ld < Lq，这种"凸极效应"非常明显。当电压矢量方向恰好在d轴时，等效电感最小，电流响应最大；当电压矢量方向在q轴时，等效电感最大，电流响应最小。因为转子磁极方向每隔180度电角度就重复一次，所以电感随电角度的变化是一个二倍频信号。也就是说，电流响应幅度 ( i(\theta_v) ) 与电压矢量角度 ( \theta_v ) 之间近似满足这种关系：
[ i(\theta_v) = I_0 + I_1 \cos(2\theta_v - 2\theta_r) ]
其中 ( \theta_r ) 就是要估计的转子电角度。如果是表面贴式PMSM（SPMSM），虽然 ( L_d \approx L_q )，但由于磁路饱和效应，在d轴正方向附近磁路更容易饱和、电感偏小，依然存在微弱但可检测的二倍频位置相关信号。只不过信号比较弱，对采样精度和滤波要求更高。
检测流程上，最常用的做法是：在静止坐标系里，依次向6个固定方向施加短时电压脉冲。这6个方向通常取0°、60°、120°、180°、240°、300°（电角度），每个方向施加一个几百微秒到几毫秒的电压矢量，同时采集相电流，算出电流响应幅度。得到6个响应值之后，就可以反推 ( I_1 ) 的相位，从而得到转子位置角度。
为什么不只测3个方向？因为3个点虽然也能解方程，但对噪声的敏感性明显更高，6个点可以做一个最小二乘意义上的基波拟合，把采样噪声匀掉一部分。在实际高精度场合，6个点的方案很常见，解析文档里把这称作"六脉冲扫描加二倍频拟合"。
在停止注入之后，绕组电流需要时间衰减到零。一般施加脉冲的持续时间 ( T_{pulse} ) 在几百微秒到一两毫秒之间，电流衰减时间 ( T_{settle} ) 则要留到3~5倍电流时间常数，避免残流影响下一次注入。对转矩和机械冲击的影响都要控制在可接受范围。
3. C代码落地：六个方向脉冲扫描与角度拟合
先声明一点：以下代码需要在"底层SVPWM已能正常输出任意幅值、任意角度电压矢量"的前提下运行。我这里只展示初始位置检测核心逻辑，底层PWM配置和ADC采样初始化按你手上的驱动库来适配。
我建议的工程文件结构是：
pmsm_init_detect/ ├── pmsm_init_detect.h // 接口和参数定义 ├── pmsm_init_detect.c // 核心检测逻辑 └── pmsm_init_detect_parse.md // 解析文档（本文对应）3.1 数据结构与关键参数
/* pmsm_init_detect.h */ #ifndef __PMSM_INIT_DETECT_H__ #define __PMSM_INIT_DETECT_H__ #include <stdint.h> typedef struct { float u_amp_pu; /* 脉冲电压幅值，标幺值 */ uint16_t pulse_time_us; /* 脉冲持续时间 */ uint16_t settle_time_us; /* 注入后等待电流衰减时间 */ uint8_t pulse_count; /* 扫描方向个数，通常为6 */ float angle_deg[6]; /* 扫描角度表 */ } init_detect_cfg_t; typedef struct { float theta_est_deg; /* 估计出来的d轴电角度 */ float theta_final_deg; /* 极性判别后的最终角度 */ float confidence; /* 拟合残差，用于评估可信度 */ float current_peak_pu[6]; /* 各方向电流响应峰值 */ } init_detect_result_t; /* 入口函数 */ int pmsm_init_detect(init_detect_cfg_t *cfg, init_detect_result_t *result); #endif参数怎么定？我以一个额定电流3A、额定母线电压24V的小型伺服电机为例来说明。这个电机的相电阻约0.8Ω，相电感约0.6mH，电气时间常数约0.75ms，机械上处于静止状态。母线电压280V？不是，这种小电机一般是低压驱动器，所以我这次拿24V平台做讲解。
脉冲电压幅值建议从5%母线电压起步，也就是 ( U_{amp} = 0.05 \times 24V = 1.2V )。如果电流响应太小、ADC量化噪声明显，可以逐步提升到10%~15%母线电压，但务必监控峰值电流不要超过额定电流的50%，否则会产生明显力矩冲击。脉冲时间取1ms左右，对应电流上升幅值大约 ( \Delta I = U \cdot T / L = 1.2 \times 0.001 / 0.0006 = 2A )。这个值在安全范围内。如果你检测到的峰值电流太大，优先减小脉冲电压而不是缩短脉冲时间，因为太窄的脉冲会让电流信号难以被PWM中点同步采样精确捕捉。
3.2 单方向脉冲注入与电流采样
/* pmsm_init_detect.c 关键代码 */ #include "pmsm_init_detect.h" extern void svpwm_set_voltage(float v_alpha_pu, float v_beta_pu); extern float adc_get_phase_current_a_pu(void); extern float adc_get_phase_current_b_pu(void); static void pwm_enable(void); static void pwm_disable(void); static void delay_us(uint16_t us);核心的单方向注入函数如下：
static void inject_voltage_vector(float angle_deg, float amp_pu, uint16_t pulse_time_us, uint16_t settle_time_us, float *peak_current) { float angle_rad = angle_deg * 3.14159265358979f / 180.0f; float v_alpha = amp_pu * cosf(angle_rad); float v_beta = amp_pu * sinf(angle_rad); /* 输出指定方向电压矢量 */ svpwm_set_voltage(v_alpha, v_beta); pwm_enable(); /* 脉冲期间做若干次ADC采样，取最大电流幅值 */ float peak = 0.0f; uint32_t t_end = 0; /* 实际工程使用定时器计数值，示意 */ while (t_end < pulse_time_us) { /* 每次采样都取电流矢量幅值 |i_s| = sqrt(ia^2 + ib^2) */ float ia = adc_get_phase_current_a_pu(); float ib = adc_get_phase_current_b_pu(); float i_mod = sqrtf(ia * ia + ib * ib); if (i_mod > peak) { peak = i_mod; } delay_us(50); } /* 撤掉电压矢量，等待电流衰减 */ svpwm_set_voltage(0.0f, 0.0f); pwm_disable(); delay_us(settle_time_us); *peak_current = peak; }这段代码里有一个很容易被忽略的工程细节：为什么采样电流时取电流矢量模值 ( |i_s| )，而不是只采某一相电流？因为电压矢量方向是任意角度的，某一相电流在扫描到不同方向上时可能恰好过零或很小，取矢量模才能把"电流响应强弱"统一量化。采样窗口要注意避开开关管的开关沿，否则尖峰噪声会直接污染峰值。大多数MCU的ADC都支持PWM触发同步采样，建议让采样时刻固定在PWM中心点附近。
另一个细节是settle_time_us。电流衰减时间要留够，否则残流会让下一个方向的初始条件不为零，从而污染该方向的电流响应。我在首次调试时吃过亏：把settle时间设短了，扫描结果出现了明显方向相关的偏差，后来把settle从500us加到2ms，数据立刻干净了很多。
3.3 六方向扫描主逻辑
int pmsm_init_detect(init_detect_cfg_t *cfg, init_detect_result_t *result) { float peak_currents[6]; /* 关闭电流环，防止中断干预 */ /* 确保电机处于静止状态，必要时打开抱闸 */ for (int k = 0; k < cfg->pulse_count && k < 6; k++) { float amp = 0.0f; inject_voltage_vector(cfg->angle_deg[k], cfg->u_amp_pu, cfg->pulse_time_us, cfg->settle_time_us, &); peak_currents[k] = amp; } /* 保存原始数据 */ for (int k = 0; k < cfg->pulse_count && k < 6; k++) { result->current_peak_pu[k] = peak_currents[k]; } /* 二倍频拟合获得d轴电角度 */ float theta_est = angle_fit_from_six_pulses(peak_currents, cfg->angle_deg); result->theta_est_deg = theta_est; /* 极性判别修正N/S极 */ float theta_final = polarity_check(theta_est, cfg->u_amp_pu, cfg->pulse_time_us, cfg->settle_time_us); result->theta_final_deg = theta_final; result->confidence = 0.0f; /* 可基于拟合残差赋值，细节略 */ return 0; }注意这里的angle_fit_from_six_pulses函数名是我自己起的，起得直白一点，后面看解析文档时容易对应。
3.4 角度拟合：为什么用二倍频而不是找最大值
有一种直觉方案是：六个方向挨个测，哪个方向电流最大，就认为那个方向是d轴方向。这个方案在扫描密度足够高时能用，但用六个点直接找最大值，角度分辨率只有相邻方向间隔的一半，也就是大约30°。对高精度伺服来说，这个分辨率不够看。
更好的做法是，把所有采样点整体揉进一个二倍频拟合里。核心公式刚才已经写过，把它展开成线性组合：
[ i_k = I_0 + A \cos(2\theta_k) + B \sin(2\theta_k) ]
其中 ( A = I_1\cos(2\theta_r) )，( B = I_1\sin(2\theta_r) )。对离散均匀分布的六个采样点，可以用离散傅里叶变换提取A和B：
static float angle_fit_from_six_pulses(const float *peak_cur_pu, const float *scan_deg) { float sum_cos = 0.0f; float sum_sin = 0.0f; const float two_pi = 6.28318530718f; for (int k = 0; k < 6; k++) { float theta_k = scan_deg[k] * 3.14159265358979f / 180.0f; sum_cos += peak_cur_pu[k] * cosf(2.0f * theta_k); sum_sin += peak_cur_pu[k] * sinf(2.0f * theta_k); } /* 幅值归一化：这里乘2/6保留基波幅值 */ float a = (2.0f / 6.0f) * sum_cos; float b = (2.0f / 6.0f) * sum_sin; /* 提取二倍频相位 */ float phase_2 = atan2f(b, a); /* 转子需要除以2 */ float theta_rad = phase_2 * 0.5f; float theta_deg = theta_rad * 180.0f / 3.14159265358979f; /* 归一化到 [0, 360) */ if (theta_deg < 0.0f) { theta_deg += 360.0f; } return theta_deg; }这段代码的精髓在于：用六个点在60°间隔的扫描角度上，捕捉二倍频信号的相位。为什么可行？因为 ( i(\theta_v) ) 是 ( 2\theta_v ) 的函数，而 ( 2\theta_v ) 在六个采样点上刚好覆盖了两个完整的二倍频周期（从0到720°）。对均匀采样序列提取基波分量，天然就能把直流偏置 ( I_0 ) 和其他高次谐波抑制掉，留下最干净的二倍频信号。
有人会问：万一电机的饱和特性和理想模型偏差比较大，二倍频不纯怎么办？实际工程中通常会看到除二倍频外还有少量四倍频、六倍频分量，它们主要来自磁路饱和的非线性。好在这类分量的频率是二倍频的整数倍，在6点均匀采样的傅里叶提取中会被投影到零或高频区域，不会直接污染二倍频相位。这也是六点方案比三点方案稳妥的原因之一。
3.5 极性判别：还差最后180度
二倍频拟合只能确定d轴所在的直线，也就是磁极轴线，但无法区分轴线上是N极朝外还是S极朝外。这在物理上表现为 ( \theta_r ) 和 ( \theta_r+180° ) 给出的电流响应完全相同。如果不做极性判别就拿这个角度去做FOC，电流环可能建在错误的磁链方向上，力矩方向整个反转。
极性判别的原理是利用永磁体的偏置磁通。沿着估计出的d轴正方向施加一个正向电压脉冲，测响应电流 ( I_+ )；再沿着反方向施加一个反向电压脉冲，测响应电流 ( I_- )。由于正向激励时电枢磁势与永磁体磁势叠加，磁路更饱和，电感更小，电流上升更快，所以 ( I_+ > I_- ) 时，说明第一个方向就是实际N极方向（或者说磁链正方向）。反之，则需要把角度翻转180度。
C代码实现：
static float polarity_check(float theta_est_deg, float u_amp_pu, uint16_t pulse_time_us, uint16_t settle_time_us) { float peak_pos = 0.0f; float peak_neg = 0.0f; /* 正向脉冲：沿估计d轴方向 */ inject_voltage_vector(theta_est_deg, u_amp_pu, pulse_time_us, settle_time_us, &peak_pos); /* 反向脉冲：沿估计d轴反方向，即+180° */ float theta_neg = theta_est_deg + 180.0f; if (theta_neg >= 360.0f) { theta_neg -= 360.0f; } inject_voltage_vector(theta_neg, u_amp_pu, pulse_time_us, settle_time_us, &peak_neg); if (peak_pos >= peak_neg) { return theta_est_deg; /* 正向就是磁链正方向 */ } else { /* 需要翻转180° */ float theta_final = theta_est_deg + 180.0f; if (theta_final >= 360.0f) { theta_final -= 360.0f; } return theta_final; } }这里有一个判断阈值的选择问题。理想情况下只要比大小就行，但实际电流采样有噪声，两个峰值可能有小幅随机波动。稳妥的做法是设置一个滞回区间：只有当峰值差超过总幅值的3%~5%时才判定为有效差异，否则保留前一次结果，或者在两个方向上各做两次测量取平均。我在实际项目中加了简单的滤波：正反检测各打两个脉冲，峰值取平均，再比较差值的符号。
4. 一次完整检测的时序设计与状态机
脉冲注入法看似只是"打脉冲、读电流"，但工程上要把它做成可靠的状态机，因为每次上电后可能遇到的事情并不只有理想情况：母线电容还没充满、抱闸还没打开、ADC参考电压还没稳定、通信模块还在等上位机指令……所以初始位置检测应该作为一个独立状态挂在系统启动流程里。
一个比较通用的时序设计是这样的：
| 阶段 | 动作 | 时间量级 |
|---|---|---|
| 预充电 | 等待母线电压稳定到设定值 | 100ms~1s |
| 静置确认 | 确认电机转速接近零，电流为零 | 10ms |
| 六方向扫描 | 每方向注入一次脉冲，等待电流衰减 | 单次约3ms，总计时约20ms |
| 角度拟合 | 执行二倍频拟合，得到d轴直线方向 | 微秒级计算 |
| 极性判别 | 沿估计轴正反各注入一次脉冲 | 约8ms |
| 输出角度 | 换算电角度并交给FOC启动模块 | 微秒级 |
| 平滑过渡 | 电流环以弱励磁方式建立，避免冲击 | 10ms以上 |
从时间上看，整段检测大约30ms~50ms就能完成。这对绝大多数伺服应用来说是完全可以接受的。有些对启动速度要求极高的场景会压缩脉冲时间到200us，但那样对ADC采样率的要求会更高，而且噪声会更明显。我的建议是：优先把可靠性做出来，再谈提速。
状态机实现的关键在于异常处理。假如某一个脉冲方向上的峰值电流为零或者明显低于其他方向，说明可能发生了几种情况：ADC通道没使能、PWM死区设置错误、或者逆变器某一路驱动没工作。做一次全方向扫描后，把六个电流峰值排序，如果最大与最小之比小于1.1，也值得警惕——这可能是电机凸极率太小或者采样噪声太大，继续解算的角度置信度不高。此时应该退出检测，报一个"初始位置检测失败"的故障，而不是带着错误角度往下跑。
在实际代码里，我会在结果结构里加一个confidence字段，计算实测电流幅值与拟合曲线之间的残差。残差大说明模型与实际偏差大，角度结果需要谨慎对待。调用方拿到这个字段后可以做分层处理：残差小直接使用结果；残差中等则重复检测一次；残差大就报故障。
5. 实测调试中最容易翻车的几个细节
代码本身不难，难的是把参数和采样细节调对。这部分我打算把自己踩过的坑按影响大小从高到低排个序，各位如果正卡在某个症状上，可以直接对照排查。
5.1 电流采样窗口与PWM开关噪声
脉冲注入法的信号本质是电流的上升波形，采样窗口必须躲开PWM开关沿。如果ADC是自由运行模式，很可能在IGBT/MOS管开通瞬间采到尖峰电流，峰值看起来很大但实际是噪声。更糟的是，噪声的幅度和相位具有随机性，会导致六点拟合结果不稳定。
解决思路：把ADC触发源改成PWM载波中点触发。对异步调制SVPWM来说，中点处三个桥臂的状态正好是零矢量，相电流续流状态稳定，是信噪比最高的采样点。如果驱动库里已经写了FOC的相电流采样，直接复用同一套触发即可。我在实验中发现，仅仅这一步就能把角度重复误差从±5°降到±1.5°以内。
5.2 转子并不是完全静止
脉冲注入法的前提是零速，但伺服电机上电瞬间可能因为机械原因处于缓慢蠕动状态，比如抱闸磨损、重力轴未平衡等。如果转子在检测期间挪动了几个度，二倍频拟合的结果就会带整体偏差。这个问题很难靠算法完全消除，工程上适合做"检测前确认":注入一个很小的低频抖动或直接读取编码器（如果有增量编码器的话，即便没寻零也可以看到低速微动）来判断转速是否接近零。如果转速超标，就等它停下来再检测。
另一种办法是减少总检测时间，比如把六个方向的脉冲串间隔压到最短、电流衰减时间精确计算，把整体窗口压缩到10ms以内。时间越短，转子挪动的距离越小，误差也就越小。
5.3 脉冲电压幅值与安全电流的平衡
有些表面贴式电机的凸极性极弱，二倍频信号只有总电流幅值的百分之几，为了把它从噪声里捞出来，很自然会想加大脉冲电压。但电压加大意味着电流峰值变大，电机上会产生明显的定位力矩冲击，严重时会让转子在脉冲作用下发生微小转动，反而破坏检测前提。
合理做法是分两步走：先用较小的电压完成粗扫，得到角度初值；再沿这个方向做局部细测，加大一点点电压并缩短脉冲时间，提高局部分辨率。这种方法有点类似通信里的"捕获+跟踪"，先粗后精，兼顾安全性和精度。
5.4 电流衰减不干净导致的方向串扰
每个方向注入结束后，绕组里有残流。如果不等它衰减到零就进入下一个方向，等效于在两个方向之间叠加了一个方向未知的初始电流偏置，破坏下一次测量的独立性。尤其是相邻方向间隔只有60°，残流方向和下一次注入方向夹角可能只有几度，串扰很隐蔽。
判断残流是否干净的简单办法：用示波器观察相电流波形，看看两次脉冲之间的电流是否确实回到了基线。如果回不到基线，先把settle时间加几倍再看。另外建议在svpwm_set_voltage(0,0)之后再额外插入一段短路制动时间，让绕组通过下桥臂续流快速耗能。
5.5 角度结果的归一化与极对数换算
这一点放在最后说，因为它最容易在代码移植时被漏掉。二倍频拟合得到的是电角度，要转换成FOC用的电角度一般直接可用，但如果你想输出给上位机显示机械角度，必须除以极对数。曾经有同事调试时发现"检测角度总在0°/30°之间跳"，排查了半天，最后发现是极对数换算漏掉了，120°的机械转向被显示成了混乱的电角度。检查代码时一定要把角度单位标注清楚，接口文档里明确写入"输入输出均为电角度"。
6. 检测完成后的启动过渡：别把好角度浪费掉
检测完初始位置之后，FOC就可以闭环起步了。但这里还有一个细节：角度是准了，电流却从零开始建立，如果不加处理直接按满力矩给定，电机会来一次"起步顿挫"。更好的做法是让电流环先以较小的励磁电流进入闭环，或者先输出一个恒定的定位力矩让转子锁定在检测出的位置上，等机械系统稳定后再加运动指令。
我常用的一种过渡写法是：检测角度 ( \theta_0 ) 出来后，给 ( dq ) 轴电流指令设成 ( i_d = 0.05I_{rated}, i_q = 0 )，让电流环运行几十毫秒，让转子被"吸"在真实位置附近，然后再进入正常速度环。这一步能消除角度估计残差带来的启动冲击。特别是高精度场合，机械抖动会直接影响后续加工或定位精度，多花20ms换一个无冲击起步非常划算。
另外，如果在现场调试时发现极性判断偶尔会翻车，可以在输出最终角度前做一次自洽性校验：在 ( \theta_{final} ) 方向施加一个微小的验证脉冲，看电流响应是否比之前的平均响应明显更大。如果实测电流反而更小，说明极性标定反了，需要检查ADC电流方向的符号约定。这是很多前期调试"角度差180°"的经典根因：不是算法错，而是电流采样的符号极性定义和SVPWM输出方向不匹配。
