永磁同步电机矢量控制C代码 全部从项目中总结得到，采用的S-function模式仿真，与实际项目运行基本一致，可以直接复制代码移植到工程实践项目中去。
搞电机控制的老司机都懂，矢量控制这玩意儿玩的就是坐标变换。上个月在调试某工业伺服项目时，愣是把Park变换的参数表写反了，电机转起来跟抽风似的。今天就拿实际项目里验证过的S-function代码开刀，各位可以直接copy去用。
坐标变换这块最容易翻车，先看Clark变换的硬核实现：
void Clark_Transform(float ia, float ib, float *i_alpha, float *i_beta) { *i_alpha = ia; *i_beta = (ia + 2.0f * ib) * ONE_BY_SQRT3; // 查表替代sqrt(3)提升实时性 }注意那个ONEBYSQRT3，老手都喜欢预计算常量。曾经有个实习生非要在中断里实时算1.732，结果采样周期直接崩了。Park变换更刺激，核心在角度处理：
float sin_theta = Sine_Table[(uint16_t)(theta * QANGLE)]; // Q格式角度量化 float cos_theta = Cosine_Table[(uint16_t)(theta * QANGLE)]; *d = cos_theta * i_alpha + sin_theta * i_beta; *q = -sin_theta * i_alpha + cos_theta * i_beta;这个QANGLE是角度量化系数，直接关系到控制精度。某次现场调试发现电机低速抖动，最后发现是Q值设太大导致角度分辨率不够，改成2^12量化立马稳如老狗。
SVPWM模块最考验代码优化能力，看这段经过战场检验的代码：
void SVPWM_Gen(float Ualpha, float Ubeta, float Ud, TIM_HandleTypeDef *htim) { float T1 = (Ubeta * Ts) / (Ud * SQRT3); float T2 = (SQRT3 * Ualpha - Ubeta) * Ts / (2.0f * Ud); float Ta = (Ts - T1 - T2) / 4.0f; htim->Instance->CCR1 = (uint16_t)(Ta * PWM_FREQ); // 直接操作寄存器提升响应 htim->Instance->CCR2 = (uint16_t)((Ta + T1) * PWM_FREQ); htim->Instance->CCR3 = (uint16_t)((Ta + T1 + T2) * PWM_FREQ); }重点在最后三行寄存器操作，比用HAL库函数快3倍不止。有个坑要注意：PWM_FREQ必须与定时器时钟同步，之前有个项目移植时忘记改这个参数，IGBT炸得那叫一个灿烂。
电流环PID的实现藏着魔鬼细节：
typedef struct { float Kp; float Ki; float integral; float limit; } PID_Controller; float PID_Update(PID_Controller *pid, float error, float Ts) { pid->integral += error * Ts; if(fabsf(pid->integral) > pid->limit) // 抗积分饱和 pid->integral = pid->limit * ((pid->integral>0)?1.0f:-1.0f); return pid->Kp * error + pid->Ki * pid->integral; }这个抗饱和处理是血的教训换来的，有次设备在堵转时积分项爆表，输出直接干到母线电压。结构体封装PID参数方便参数整定，现场调参时记得先把Ki设零，不然电机分分钟给你表演霹雳舞。
闭环控制主循环这样搞：
void PMSM_Control(void) { static float theta = 0.0f; // 硬件ADC读取三相电流 Clark_Transform(ia, ib, &ialpha, &ibeta); Park_Transform(ialpha, ibeta, theta, &id, &iq); float torque_ref = PID_Update(&speed_pid, w_ref - w_meas, Ts); float iq_ref = torque_ref / (1.5f * POLE_PAIRS * FLUX_LINKAGE); Vd = PID_Update(¤t_pid_d, id_ref - id, Ts); Vq = PID_Update(¤t_pid_q, iq_ref - iq, Ts); Inverse_Park(Vd, Vq, theta, &Valpha, &Vbeta); SVPWM_Gen(Valpha, Vbeta, Vdc, &htim1); theta += w_meas * Ts * POLE_PAIRS; // 位置观测 if(theta > 6.28319f) theta -= 6.28319f; }注意那个位置积分，必须做模运算防止浮点数溢出。某次连续运行72小时后theta变量溢出，电机突然反转把传送带绞成了麻花。速度环和电流环的采样周期要分开，电流环建议放在PWM中断里执行，这个结构是裸跑时的框架，实际项目记得加上过流保护。
这套代码在STM32F4和TI C2000系列上都验证过，移植时重点关注三点：ADC采样对齐方式、PWM死区时间设置、Q格式量化精度。代码里所有浮点运算都可以改成定点数优化，下次有空再唠怎么用IQmath库榨干DSP性能。
