基于DSP28335的永磁同步电机控制程序案例：FOC、SVPWM与双闭环PID控制

永磁电机电机控制程序代码 DSP28335电机控制程序案例 永磁同步电机霍尔传感FOC SVPWM 速度电流双闭环 2 永磁同步正交编码ABZ FOC SVPWM 速度电流双闭环 3 永磁同步无感 FOC SVPWM 速度电流双闭环 4 永磁同步电机磁编码器FOC SVPWM 速度电流双闭环 5三相交流异步VF SVPWM调速控制 6 直流无刷电机霍尔传感方波速度电流双闭环PID控制 7直流无刷无传感方波速度电流双闭环PID控制最近在调几个DSP28335的电机控制项目发现不同传感器方案的代码架构差异比想象中大多了。就拿永磁同步电机来说光是位置检测方案不同整个观测器和控制算法都得跟着调整。今天咱们就着几个典型方案看看代码该怎么撸。永磁电机电机控制程序代码 DSP28335电机控制程序案例 永磁同步电机霍尔传感FOC SVPWM 速度电流双闭环 2 永磁同步正交编码ABZ FOC SVPWM 速度电流双闭环 3 永磁同步无感 FOC SVPWM 速度电流双闭环 4 永磁同步电机磁编码器FOC SVPWM 速度电流双闭环 5三相交流异步VF SVPWM调速控制 6 直流无刷电机霍尔传感方波速度电流双闭环PID控制 7直流无刷无传感方波速度电流双闭环PID控制先说最常见的霍尔传感FOC方案。初始化阶段有个关键点——霍尔信号极性处理。之前有个坑某款电机霍尔安装相位差了30度直接导致转子角度计算翻车。后来在QEP模块配置里加了补偿EQep1Regs.QPOSINIT 0; // 初始化位置计数器 EQep1Regs.QPOSMAX 600; // 对应机械角度360° EQep1Regs.QDECCTL.bit.SWAP 1; // AB信号交换 EQep1Regs.QEPCTL.bit.PHEN 1; // 使能位置计数器霍尔中断里要做六步换向补偿这里用查表法更稳const float HallAngle[6] {0.0, 60.0, 120.0, 180.0, 240., 300.}; void Hall_ISR(){ uint16_t state (GpioDataRegs.GPBDAT 10) 0x07; MechAngle HallAngle[state] * PI / 180; }电流环采样别省事ADC同步触发得卡准点。我们采用EPWM1的SOC触发ADC采样EPwm1Regs.ETSEL.bit.SOCAEN 1; // 使能SOC EPwm1Regs.ETSEL.bit.SOCASEL 1; // 计数等于0时触发 EPwm1Regs.ETPS.bit.SOCAPRD 1; // 单次触发碰到无感方案时滑模观测器是必备技能。这段代码实现位置估算float est_theta 0; void SMO_Update(float ialpha, ibeta){ float e_alpha ialpha - est_i_alpha; float e_beta ibeta - est_i_beta; // 滑模面计算 float z_alpha (e_alpha 0) ? 1 : -1; float z_beta (e_beta 0) ? 1 : -1; // 反电动势观测 emf_alpha K_SLIDE * z_alpha; emf_beta K_SLIDE * z_beta; // 角度提取 est_theta atan2(emf_beta, emf_alpha); }重点说下磁编码器的坑。某次用AS5047P时SPI读取的14位数据要做奇偶校验uint16_t Read_Encoder(){ SpiRegs.SPITXBUF 0xFFFF; // 发送读取命令 while(!SpiRegs.SPISTS.bit.INT_FLAG); uint16_t data SpiRegs.SPIRXBUF; if((parity_check(data) ! (data 15))){ ErrorCount; return LastValidData; // 校验失败用上次数据 } return data 0x3FFF; // 取低14位 }直流无刷的方波控制反而更考验换相时机。这个换相表实测有效const uint16_t CommutationTable[6] { PWM_AH | PWM_BL | PWM_CL_OFF, PWM_AH_OFF | PWM_BH | PWM_CL, PWM_AL | PWM_BH | PWM_CH_OFF, PWM_AL | PWM_BL_OFF | PWM_CH, PWM_AH_OFF | PWM_BL | PWM_CH, PWM_AH | PWM_BL_OFF | PWM_CL };速度环PID别直接用浮点Q格式定点更靠谱。比如Q15格式处理int32_t Speed_PID(int32_t ref, int32_t fbk){ static int32_t integ 0; int32_t err ref - fbk; integ Ki * err; integ (integ MAX_INTEG) ? MAX_INTEG : integ; int32_t output (Kp * err) integ; return output 15; // 转回实际值 }调试中发现VF控制的三相异步电机启动时得做电压补偿。这个斜坡函数实测有效void VF_RampUp(){ static float freq 0; if(freq TargetFreq){ freq 0.5; // 0.5Hz步进 Vout (freq / BaseFreq) * RatedVoltage; Set_PWM_Freq(freq); } }最后说个血泪教训所有PWM输出务必配置死区曾经烧过一打IPM模块才长记性EPwm1Regs.DBCTL.bit.OUT_MODE 0x3; // 上升沿死区 EPwm1Regs.DBRED DeadTime; // 上升沿延迟 EPwm1Regs.DBFED DeadTime; // 下降沿延迟代码是死的电机是活的。实际调试时别迷信仿真数据上电前先限流示波器盯相电流波形比看代码管用百倍。不同电机参数差异大别指望一套参数吃遍天自适应算法该加还得加。