STM32C5 LL‑CORDIC 例程

STM32C5 内置 CORDIC 硬件协处理器，用于硬件加速 sin/cos、反正切、模值等数学运算，在 FOC 电机控制场景可以大幅减轻 CPU 运算负担。但是芯片刚发布阶段，STM32CubeC5 软件包没有直接提供 LL 库 CORDIC 完整示例工程。

LAT1703 给出一套成熟移植方案：复用 STM32G4 官方 LL‑CORDIC 工程（CORDIC_CosSin），迁移到 STM32C5 平台，实现 Q1.31 格式下 cos/sin 硬件运算校验。本文还原测试环境、完整移植步骤、关键代码、定点格式说明、调试排查要点。

说明：STM32C5 与 G4 的 CORDIC 外设寄存器、LL API 基本兼容，可以直接复用 G4 例程的算法逻辑。

资料获取：实战经验 | LAT1703 stm32c5 LL cordic例程

1. 测试环境

硬件：NUCLEO‑C5A3ZG 开发板
IDE：IAR 9.70.4
源参考例程：STM32Cube_FW_G4_V1.5.0\Projects\NUCLEO‑G474RE\Examples_LL\CORDIC\CORDIC_CosSin\Src
基础工程模板：STM32Cube_SW_Package_C5_2.0.0‑alpha.4.0 包内examples\ll\gpio工程，作为移植基底。

2. 完整移植实施步骤

复制基础工程 复制 GPIO 示例工程，重命名为gpio‑cordic，IAR 打开该工程，作为 CORDIC 移植基底。
拷贝宏定义（Q1.31 定点相关） 将 G4 例程 main.c 里面的宏全部复制到 C5 工程 main.c 头部：

/* Pass/Fail Status */
#define PASS 0
#define FAIL 1

/* Reference values in Q1.31 format */
#define ANGLE_CORDIC  (int32_t)0x10000000  /* pi/8 CORDIC输入角度映射 */
#define ANGLE_LIB     (int32_t)0x08000000  /* pi/8 ARM数学库输入角度映射 */
#define MODULUS       (int32_t)0x7FFFFFFF  /* 模等于1 */
#define COS_REF       (int32_t)0x7641AF3C  /* cos(pi/8)参考结果 */
#define SIN_REF       (int32_t)0x30FBC54D  /* sin(pi/8)参考结果 */
#define DELTA         (int32_t)0x00001000  /* 最大允许残差，6cycle精度，2^‑19误差 */

拷贝结果变量

/* cos and sin results */
int32_t cosOutput = 0;
int32_t sinOutput = 0;

拷贝残差校验函数与 CORDIC 计算函数

uint32_t Check_Residual_Error(int32_t VarA, int32_t VarB, uint32_t MaxError)
{
  uint32_t status = PASS;
  if ((VarA - VarB) >= 0)
  {
    if ((VarA - VarB) > MaxError)
    {
      status = FAIL;
    }
  }
  else
  {
    if ((VarB - VarA) > MaxError)
      status = FAIL;
  }
  return status;
}

static void LL_cordic_calculate(void)
{
  LL_AHB1_GRP1_EnableClock(LL_AHB1_GRP1_PERIPH_CORDIC);

  /* CORDIC外设配置，计算余弦，同时输出cos、sin */
  LL_CORDIC_Config(CORDIC,
                   LL_CORDIC_FUNCTION_COSINE,    /* 余弦函数 */
                   LL_CORDIC_PRECISION_6_CYCLE, /* Q1.31最大精度 */
                   LL_CORDIC_SCALING_FACTOR_0,  /* 无缩放 */
                   LL_CORDIC_NBWRITE_1,         /* 仅写入角度，模值复位后默认为1 */
                   LL_CORDIC_NBREAD_2,          /* 读取2个结果：cos，sin */
                   LL_CORDIC_INWIDTH_32_BIT,    /* Q1.31输入 */
                   LL_CORDIC_OUTWIDTH_32_BIT);  /* Q1.31输出 */

  LL_CORDIC_WriteData(CORDIC, ANGLE_CORDIC);

  cosOutput = (int32_t)LL_CORDIC_ReadData(CORDIC);
  sinOutput = (int32_t)LL_CORDIC_ReadData(CORDIC);

  /* 校验残差，超出阈值进入错误处理 */
  if ((Check_Residual_Error(cosOutput, COS_REF, DELTA) == FAIL) ||
      (Check_Residual_Error(sinOutput, SIN_REF, DELTA) == FAIL))
  {
    error_handler();
  }
}

main 函数调用执行 在 main 主循环或者初始化段调用LL_cordic_calculate()；调试观察cosOutput、sinOutput变量，和参考值比对。运算结果在允许残差DELTA以内，代表 CORDIC 硬件工作正常。

关键点：示例使用 CORDIC 零开销单次模式，写入角度自动启动运算，直接读取结果，不需要额外轮询标志位。

3. Q1.31 定点格式简要说明

CORDIC 硬件使用Q1.31 定点格式，范围 [-1 ~ +1]；0x7FFFFFFF 代表 + 1，0x80000000 代表‑1。
示例输入角度为 π/8，ANGLE_CORDIC=0x10000000；
DELTA=0x1000 代表允许最大残差，对应 2^‑19，是 6‑cycle 迭代精度对应的误差边界；
注意 CORDIC 角度输入范围：归一化角度范围 [-1，1]，等价 [-π，π] 弧度，超出范围需要软件做角度取模。

4. 工程落地排查清单

编译报错：LL_CORDIC_xxx 函数未定义
- 确认工程已经添加 STM32C5 LL 驱动头文件与源文件；检查stm32c5xx_ll_cordic.h头文件是否被 include。
直接进入 error_handler，校验残差失败
- 核对 CORDIC 时钟是否开启LL_AHB1_GRP1_EnableClock(LL_AHB1_GRP1_PERIPH_CORDIC)；
- 核对配置参数：精度、输入输出位宽、读写数目，严格匹配 Q1.31；
- 确认输入角度常量ANGLE_CORDIC数值。
调试读取变量全部为 0
- 确认执行顺序：先使能外设时钟，再执行 LL_CORDIC_Config，之后写输入数据，再读取结果；
- 零开销单次模式，写完数据硬件自动运算，直接读结果。
从 G4 迁移到 C5，是否所有 LL‑CORDIC 接口完全一样？
- 寄存器功能、LL API 高度兼容；移植完成务必实测校验输出残差；部分时钟总线需要核对 C5 参考手册 RM0522。

5. 小结

STM32C5 初期软件包没有自带 LL‑CORDIC 示例；可以复用 STM32G4 的 CORDIC_CosSin 例程移植，C5/G4 的 CORDIC 外设 LL 驱动 API 高度兼容。
移植方法：以 C5 自带 LL‑GPIO 工程作为基底，复制定点宏定义、残差校验函数、CORDIC 配置运算函数；调用之后比对输出 cos/sin 和参考值，在 DELTA 残差范围内代表硬件协处理器工作正常。
本示例使用 Q1.31 定点格式、零开销单次模式，适合 FOC 电机控制三角函数加速；输入角度需要做归一化处理。
该移植思路同样可以扩展到 atan、hypot 等其它 CORDIC 运算功能。

6. FAQ

Q：HAL 库 CORDIC 例程可以同样移植到 C5 吗？

A：文档使用 LL 底层驱动；HAL 版本逻辑类似，同样需要注意 C5 时钟总线差异。

Q：CORDIC 零开销单次模式，为什么不需要等待就绪标志？

A：零开销单次模式，写入输入数据硬件自动完成全部迭代，读寄存器直接返回运算结果，适合单任务简单计算场景。

Q：可以直接把该示例用于 FOC 电机控制吗？

A：可以作为功能验证模板；实际 FOC 需要增加角度归一化、角度限幅，根据业务切换不同 CORDIC 运算模式。

免责声明：本文全部基于 ST 官方 LAT1703 文档，寄存器配置、时钟总线请以 STM32C5 参考手册 RM0522 为准。