1.前言
STM32G431系列产品内置了CORDIC运算单元,可以用来加速数学计算,如三角函数、取模、开方等。适合大量数据进行相同的运算操作。配合DMA可以大大节省CPU计算开销。
2.CubeMX配置
使用CORDIC模块无需配置参数,若采用DMA方式则只需配置DMA读写通道,配置如下
3.相关代码
在代码中对cordic模块进行初始化,主要是完成对CORDIC_ConfigTypeDef结构体的配置。
声明结构体变量
CORDIC_ConfigTypeDef sCordicConfig;
具体配置函数如下:
void cordic_config(void)
{
sCordicConfig.Function = CORDIC_FUNCTION_SINE; /* sine function */
sCordicConfig.Precision = CORDIC_PRECISION_6CYCLES; /* max precision for q1.31 sine */
sCordicConfig.Scale = CORDIC_SCALE_0; /* no scale */
sCordicConfig.NbWrite = CORDIC_NBWRITE_1; /* One input data: angle. Second input data (modulus) is 1 after cordic reset */
sCordicConfig.NbRead = CORDIC_NBREAD_2; /* One output data: sine */
sCordicConfig.InSize = CORDIC_INSIZE_32BITS; /* q1.31 format for input data */
sCordicConfig.OutSize = CORDIC_OUTSIZE_32BITS; /* q1.31 format for output data */
HAL_CORDIC_Configure(&hcordic, &sCordicConfig);
}
这里使用了cordic模块计算sin和cos函数,传入参数1个(角度),传出参数2个(sin和cos值),输入输出数据都是32位。具体内容可以参考ST官方手册。
HAL库中使用DMA方式进行cordic计算对应的函数为HAL_StatusTypeDef HAL_CORDIC_Calculate_DMA(CORDIC_HandleTypeDef *hcordic, int32_t *pInBuff, int32_t *pOutBuff, uint32_t NbCalc, uint32_t DMADirection)
,该函数有5个入口参数,分别是:cordic结构体地址、输入数据地址、输出数据地址、转换次数、DMA数据方向。可以将其进一步封装成cordic_calculate_start
函数,具体代码如下:
int32_t pInBuff; //输入数据
int32_t pOutBuff[2]; //输出数据
void cordic_calculate_start(float arg1)
{
//传入的是归一化角度[0, 1.0]
if(arg1 > 0.5f) //将角度从[0, 1.0]转换到[-0.5, 0.5]
arg1 -= 1.0f;
pInBuff = value_to_cordic31(arg1, 0.5f); //[-0.5, 0.5]对0.5f归一化,转换到[-1.0, 1.0],并用Q31定点数据表示
//传入的是弧度值[0, 6.28]
/*if(arg1 > 3.14f) //将角度从[0, 6.28]转换到[-3.14, 3.14]
arg1 -= 6.28f;
pInBuff = value_to_cordic31(arg1, 3.14f); //[-3.14, 3.14]对3.14f归一化,转换到[-1.0, 1.0],并用Q31定点数据表示
*/
HAL_CORDIC_Calculate_DMA(&hcordic, &pInBuff, pOutBuff, 1, CORDIC_DMA_DIR_IN_OUT); //开始转换
}
值得注意的是,cordic模块计算sin和cos要求传入角度取值在[-1,1](对应弧度值[-PI, PI]),并且需要用Q31定点格式来表示。因此采用函数value_to_cordic31
对角度格式进行转换,具体代码为:
int32_t value_to_cordic31(float value, float coeff)
{
int32_t cordic31;
cordic31 = (int32_t)((value/coeff)*0x80000000); //value对coeff归一化,然后扩大2^31倍,取整得到Q31定点数据
return cordic31;
}
DMA转换完成后,结果会自动存放到指定的输出地址处,我们就可以直接读取了。
void cordic_get_result(float *res1, float *res2)
{
while (HAL_CORDIC_GetState(&hcordic) != HAL_CORDIC_STATE_READY); //等待cordic模块空闲
cordic31_to_value(pOutBuff[0], res1); //正弦值转浮点
cordic31_to_value(pOutBuff[1], res2); //余弦值转浮点
}
读到的数据也是Q31定点格式,可以采用cordic31_to_value
函数将其转换成浮点数。(正数直接缩小2^31倍,负数由于是以补码形式存储,需要先去掉最高位符号位,然后转换成原码,再进行缩小)
void cordic31_to_value(int cordic31, float *res)
{
if(cordic31&0x80000000) //为负数
{
cordic31 = cordic31&0x7fffffff;
*res = ((float)(cordic31)-0x80000000)/0x80000000;
}
else //为正数
{
*res = (float)(cordic31)/0x80000000;
}
}
4.总结
STM32G系列内置CORDIC模块可以加速三角函数等数学运算,且拥有较高的计算精度。CORDIC模块单次转换速度可能与查表法没有太大差距,但其优势在于,可以同时对大量数据进行相同的运算操作,同时节省CPU资源。使用时,需要按照手册对数据进行浮定点转换以及标幺处理。另外,使用过程中发现,DMA模式下更改CORDIC模块配置进行不同的数学运算,得到的计算结果会出错,因此DMA模式只适用于相同数学运算的应用场景。
参考资料:1.https://shequ.stmicroelectronics.cn/thread-635016-1-1.html
2.ST官方CORDIC例程