STM32F4高频注入完整工程 源代码和原理图,完整工程。
最近在调无感FOC的高频注入方案,发现STM32F4系列用来做这个真是香。今天咱们直接上干货,分享一套实测可用的高频注入完整工程,从硬件接线到代码实现全都跑通了。(文末附完整工程下载)
先说硬件配置,定时器TIM1的三路互补PWM直接驱动IPM模块,注意死区时间一定要留够。这里有个骚操作:把TIM1的时钟源配置成内部时钟的4分频,配合ARR寄存器设置,轻松实现20kHz的PWM载波频率。看这段核心配置:
// TIM1时钟配置 RCC_APB2PeriphClockCmd(RCC_APB2Periph_TIM1, ENABLE); TIM_TimeBaseStructure.TIM_Prescaler = 3; // 84MHz/4=21MHz TIM_TimeBaseStructure.TIM_Period = 1050-1; // 21MHz/1050=20kHz TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; TIM_TimeBaseInit(TIM1, &TIM_TimeBaseStructure);重点在TIMPrescaler和TIMPeriod这对黄金搭档,想改频率直接调这两个参数就行。比如要25kHz就把Period改成840,数学不好的可以直接用STM32CubeMX自动计算。
高频信号注入的关键在于怎么在PWM里藏私货。这里用了个取巧的办法——在电压矢量中叠加高频扰动。代码里专门开了个DMA通道搬运高频信号表,配合TIM8触发ADC采样,这个时序控制贼重要:
// 高频信号注入函数 void HF_Injection(float angle) { static uint16_t hf_table[256]; // 生成高频正弦表(实际项目用查表法优化速度) for(int i=0; i<256; i++){ hf_table[i] = (uint16_t)(200 * sin(2*PI*i/256) + 2048); } // DMA配置传输到DAC DMA_Cmd(DMA1_Stream5, DISABLE); DMA_SetCurrDataCounter(DMA1_Stream5, 256); DMA_Cmd(DMA1_Stream5, ENABLE); }注意那个200的幅度值,调太大电机叫得跟电锯似的,调小了又采不到信号。实测150-250之间比较稳,具体看电机参数。
STM32F4高频注入完整工程 源代码和原理图,完整工程。
说到ADC采样,一定要锁住PWM中心对齐模式。ADC的采样窗口刚好卡在PWM的中间点,这样采到的反电动势才干净。看这个ADC触发配置:
// ADC同步采样配置 ADC_RegularChannelConfig(ADC1, ADC_Channel_0, 1, ADC_SampleTime_480Cycles); ADC_ExternalTrigConvEdgeConfig(ADC1, ADC_ExternalTrigConvEdge_Rising); ADC_ExternalTrigConvConfig(ADC1, ADC_ExternalTrigConv_T8_CC1);这里用TIM8的CC1事件触发ADC,采样率直接和PWM频率挂钩。如果发现采样值跳得厉害,先查硬件滤波电路,八成是RC参数没调好。
最后说说位置解算的骚操作。传统方案要搞一堆滤波器,这里直接用相敏检波+锁相环暴力破解:
// 位置解算核心代码 void Position_Estimate(void) { float hf_component = alpha*cos_hf + beta*sin_hf; float phase_error = hf_component * ref_hf; // 锁相环更新角度 pll_angle += (phase_error * pll_kp + pll_integral * pll_ki) * dt; pll_integral += phase_error * dt; // 防止积分饱和 if(pll_integral > PI) pll_integral -= 2*PI; }这个pllkp参数调起来很玄学,建议从0.1开始慢慢加,直到电机能稳稳启动。遇到角度抖动的话,把pllki设成kp的1/10试试。
完整工程里包含了原理图和参数配置工具(在/Utilities文件夹),调试时记得先接小功率电机!上次我手抖接了个3kW的,上电瞬间直接跳闸,工位跳了三次后来就被拉闸了...
需要源码的戳这里:[GitHub链接屏蔽] 别忘点star啊,调参调秃头的兄弟记得回来还愿。下期可能会讲怎么用这套方案做零速带载启动,看点赞数了(暗示)。