STM32 使用IQmath實現SVPWM

IQMATH

TI的片子很香，做的也很好，但是成本相對ST會更高，電機控制方面，TI無疑是做的最好的方案之一，另外TI針對沒有浮點運算器的定點DSP推出了IQMATH庫，在使用Q格式對數據進行分析和處理的過程中，十分方便，代碼也變得更加簡潔，本文將使用TI的方案實現SVPWM，在這里感謝TI。

測試平台參數：
硬件：stm32f103
軟件：標准外設庫3.5
IDE：MDK-ARM

添加IQmathLib到工程中

將IQmathlib解壓可以得到如下文件，其中包含各個平台下的靜態庫，本文使用STM32F1在keil環境下進行開發，需要使用的是rvmdk-cm3。

打開一個keil工程，在菜單界面點擊如下圖所示的圖標進入project items；

添加IQmath組，並添加rvmdk-cm3路徑下的靜態庫，和頭文件；

點擊下圖所示的圖標進入工程熟悉的設置；

添加rvmdk-cm3靜態庫的路徑，和頭文件的包含路徑，如下圖所示；

最終，build整個工程即可。

測試部分程序

/** ****************************************************************************** * @file Project/STM32F10x_StdPeriph_Template/main.c * @author MCD Application Team * @version V3.5.0 * @date 08-April-2011 * @brief Main program body ****************************************************************************** * @attention * * THE PRESENT FIRMWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS * WITH CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE * TIME. AS A RESULT, STMICROELECTRONICS SHALL NOT BE HELD LIABLE FOR ANY * DIRECT, INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING * FROM THE CONTENT OF SUCH FIRMWARE AND/OR THE USE MADE BY CUSTOMERS OF THE * CODING INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS. * * <h2><center>&copy; COPYRIGHT 2011 STMicroelectronics</center></h2> ****************************************************************************** */  

/* Includes ------------------------------------------------------------------*/
#include "stm32f10x.h"
#include <stdio.h>
#include <stdint.h>

#include "serial_scope.h"
#include "common.h"
#include "IQmathLib.h"
#include "usart_driver.h"
#include "clarke.h"
#include "park.h"
#include "svpwm.h"

/** * @brief Main program. * @param None * @retval None */
sv_mod_t svpwm = SVGEN_DEFAULTS;

#define CLARK 0
#define PARK 1
#define SVPWM 2
#define SVPWM_REG 3

int main(void)
{
	int user_data[4] = { 0 };
	static int16_t time_cnt = 0;
	Trig_Components a;
	Trig_Components b;
	_iq final_angle;
	usart_init();	

	while (1)
	{		
		time_cnt-=32;
		
		clarke_parameter.As = _IQsinPU(time_cnt);
		clarke_parameter.Bs = _IQsinPU(time_cnt-0x5555);
		
		if(clarke_parameter.As > 32767){
			clarke_parameter.As = 32767;
		}
		if(clarke_parameter.As < -32768){
			clarke_parameter.As = -32768;
		}
		
		if(clarke_parameter.Bs > 32767){
			clarke_parameter.Bs = 32767;
		}
		if(clarke_parameter.Bs < -32768){
			clarke_parameter.Bs = -32768;
		}
		
		clarke_calc(&clarke_parameter);
		
		park_parameter.Alpha = clarke_parameter.Alpha;
		park_parameter.Beta = clarke_parameter.Beta;
		
		park_parameter.Sin = trig_functions(time_cnt).hsin;
		park_parameter.Cos = trig_functions(time_cnt).hcos;
		park_parameter.Angle = -time_cnt;
		park_calc(&park_parameter);
		
		svpwm.Ualpha = clarke_parameter.Alpha;
		svpwm.Ubeta = clarke_parameter.Beta;
		
		svpwm_calc(&svpwm);
		
		#define FOC_DEBUG SVPWM_REG
#if (FOC_DEBUG == CLEAK)
		user_data[0] = clarke_parameter.As;
		user_data[1] = clarke_parameter.Bs;
		user_data[2] = clarke_parameter.Alpha;
		user_data[3] = clarke_parameter.Beta;		
#elif (FOC_DEBUG == PARK)
		user_data[0] = clarke_parameter.As;
		user_data[1] = clarke_parameter.Bs;
		user_data[2] = park_parameter.Ds;
		user_data[3] = park_parameter.Qs;
#elif (FOC_DEBUG == SVPWM) 
		user_data[0] = (uint16_t)svpwm.Ta;
		user_data[1] = (uint16_t)svpwm.Tb;
		user_data[2] = (uint16_t)svpwm.Tc;
		user_data[3] = svpwm.VecSector*5000;
#elif (FOC_DEBUG == SVPWM_REG)
		
		//換算的CCRx寄存器的值
		sv_regs_mod_t sv_regs = svpwm_get_regs_mod(7200,&svpwm);
		
		user_data[0] = sv_regs.ccr1;
		user_data[1] = sv_regs.ccr2;
		user_data[2] = sv_regs.ccr3;
		user_data[3] = svpwm.VecSector*1000;
#endif
		SDS_OutPut_Data_INT(user_data);
	}
	return 0;
}

/** * @} */

/******************* (C) COPYRIGHT 2011 STMicroelectronics *****END OF FILE****/