你的浏览器版本过低,可能导致网站不能正常访问!
为了你能正常使用网站功能,请使用这些浏览器。

【经验分享】STM32G4_CORDIC与定点带符号整数数据格式

[复制链接]
STMCU小助手 发布时间:2022-5-27 19:47
STM32G4_CORDIC与定点带符号整数数据格式

2019年ST推出的G4系列芯片是STM32系列第一款带有CORDIC协同处理器的芯片。CORDIC协同处理器提供某些数学函数的硬件加速,尤其是三角函数。它能加快这些函数的运算,释放处理器以执行其他任务。通常用于电机控制、测量、信号处理和许多其他应用。

- s4 v( D( d  R# t8 h9 Z

1. 关于CORDIC

CORDIC(coordinate rotation digital computer坐标旋转数字计算机)是一种用于计算三角函数和双曲线函数的低成本逐次逼近算法。最初由Jack Volder在1959年提出,它被广泛用于早期计算器当中。CORDIC算法通过基本的加和移位运算代替乘法运算,具体原理不在此赘述。


, j7 v, p4 l# c0 s0 O. N" [1 [2 [

640 (7).png 坐标旋转算法示意图0 z8 J# ^9 q9 n$ I0 [
+ H; q. A* f8 E
2. STM32G4中使用CORDIC2.1 初始配置

使用STM32CubeMX激活CORDIC,再按需选择配置NVIC或者DMA。生成代码支持HAL库和LL库。此时代码包含了CORDIC的初始化(CORDIC_Initialize),不包括CORDIC的配置(CORDIC_Configure)。需要用户自行实例化结构体CORDIC_ConfigTypeDef:

- s! I5 ^8 Q! L# f% H6 ?: \" _" D

640 (6).png # C" q. c) D7 w' D
结构体成员变量& G/ _5 o) Q* j' `, K( l
1 T7 N7 e8 w* Z( U0 ^

Function包含共10种函数:余弦、正弦、方位角、取模、反正切、双曲余弦、双曲正弦、双曲反正切、自然对数、开平方。

Scale指缩放因子;CORDIC要求输入数值在[-1,1]区间内;设输入值为x,缩放因子为n,则会先对输入数值做运算x=x·2^-n,CORDIC计算完成后输出结果y再做运算y=y·2^n;缩放因子取值范围视所选函数规定,在[0,7]区间内;缩放因子可能会导致运算精度的丢失。(可查阅ST官方文档:RM0440)

InSize与OutSize:提供两种输入输出数据格式Q1.31和Q1.15;每次向CORDIC输入数据时,会发送一个32位的数据,当选择Q1.31数据格式时,CORDIC一次运算一个数据;当选择Q1.15数据格式时,将两个数据封装在一个32位数据中,CORDIC一次运算两个数据;选择Q1.15数据格式能提高运算速度,但牺牲了运算精度;有关Q1.31和Q1.15数据格式的内容下文会讲到。

NbWrite与NbRead:写入写出的参数数量;有些函数,比如求方位角、取模,需要输入x,y两个参数才能进行运算;有些函数,比如余弦、正弦,CORDIC运算后可以输出两个结果,例如进行余弦函数运算时,可以输出一个余弦结果和一个正弦结果;两个数据以交替的形式进行输入输出;输入时若次要参数一直保持不变,可在第一次计算开始后将NbWrite设置为1个参数输入模式。(可查阅ST官方文档:RM0440)

Precision指迭代周期;取值范围为1到13;迭代周期越多,运算精度越高,运算速度越低;当运算精度到达数据格式所能表达的精度极限时,继续增加迭代周期毫无意义,例如迭代6周期运算已经达到Q1.31数据格式正弦函数运算所能表达的精度极限,继续增加迭代周期的运算结果与迭代6周期的运算结果无异;对于大多数函数,迭代周期推荐3到6周期。

配置完结构体变量,后使用CORDIC_Configure函数将数据写入CORDIC_CSR寄存器,CORDIC的初始化和配置完成。

640 (5).png

函数输入与输出
% t& ?: K8 |; V& J! k) R7 F

$ K% E3 D( E# ]$ V

640 (4).png

$ h1 @! e. ?7 H  U

CORDIC_CSR寄存器
  \; |. l" A) Q* H& \

: A5 |* a0 L2 m: }" p8 a. A: W/ L
# }1 f, ?: f8 G1 g. z5 t2.2 CORDIC的读写操作步骤
  • 零开销模式(Zero-overhead mode)

    该模式下CORDIC运算效率最高,上一个结果被读取后即刻开始下一次运算,期间没有空闲时间;该模式中CPU的占用率为100%。

    : V) f4 z( g% k( Q* |" Y

    # ?& ~% K4 y- ]- W6 E
  • 配置CORDIC_CSR寄存器,也就是初始化和配置CORDIC;
  • 向CORDIC_WDATA寄存器写入参数,写入完成后CORDIC将会开始第一次计算;
  • 如果需要,为下一次计算重新配置CORDIC_CSR寄存器,此时不论上一个计算是否完成,重新配置CSR寄存器不会对上一次计算结果产生影响;
  • 向CORDIC_WDATA寄存器写入下一次计算所需参数;
  • 从CORDIC_RDATA寄存器读取上一次计算的结果,读取结果的操作完成后会触发下一次计算的开始;一旦开始计算,读取CORDIC_RDATA寄存器的操作都会插入AHB总线等待状态,直到计算结束才返回结果;因此,即使CORDIC未运算出结果,也可以进行读操作,当计算结果返回时读操作完成;
  • 重复第3至第6步骤;
  • 从CORDIC_RDATA寄存器读取最后一个结果,完成计算。
    ( \% p; O9 }, ?  o% b
* |) E: Z) v/ I% n
640 (3).png
; k+ z: I% y) v% _% ?* ?7 T零开销模式示意图
. Y# X( I% M& g: F. n2 l
* Q3 ~5 b. u: M: T! S9 I( x7 u
  • 轮询模式(Polling mode)

    该模式会轮询CORDIC_CSR寄存器的RRDY标志位以判断运算完成;该模式不会使CPU处于100%的占用率,使CPU可以处理其他任务;轮询模式会比零开销模式消耗稍长时间,因为计算完成后结果不会立即被读取,需要等待下一个轮询周期到来,且读取RRDY标志位后再读取结果会产生延迟。

    & k% t) e0 V4 U% h2 H

    4 l% T2 s) ]+ N% U5 z
  • 配置CORDIC_CSR寄存器,也就是初始化和配置CORDIC;
  • 向CORDIC_WDATA寄存器写入参数,写入完成后CORDIC将会开始第一次计算;
  • 如果需要,为下一次计算重新配置CORDIC_CSR寄存器,此时不论上一个计算是否完成,重新配置CSR寄存器不会对上一次计算结果产生影响;
  • 向CORDIC_WDATA寄存器写入下一次计算所需参数;
  • 轮询CORDIC_CSR寄存器的RRDY标志位,直到该位被置1;
  • RRDY标志位置1时,从CORDIC_RDATA寄存器读取上一次计算的结果,读取结果的操作完成后会触发下一次计算的开始;
  • 重复第3至第7步骤;
  • 从CORDIC_RDATA寄存器读取最后一个结果,完成计算。
    . \* F0 x! [8 F
    . Y9 J3 I% Z1 b6 ]

  • 9 q5 T7 Q; h+ x' z) R
  • 中断模式(Interrupt mode)

    当RRDY标志位被置1时产生中断信号,该位被置0时会清除中断标志位;该模式下使得结果的读取具有优先级;因此会比零开销模式和轮询模式消耗更长时间。


    8 |( {4 S' ?; Z' R( E5 R( z

    ' s8 W1 ]% V& x: ]0 b7 }1 v( `# \
  • 配置CORDIC_CSR寄存器,也就是初始化和配置CORDIC,并且设置IEN位为1;可以直接在STM32CubeMX中设置为中断模式;
  • 向CORDIC_WDATA寄存器写入参数,写入完成后CORDIC将会开始第一次计算;
  • 如果需要,为下一次计算重新配置CORDIC_CSR寄存器,此时不论上一个计算是否完成,重新配置CSR寄存器不会对上一次计算结果产生影响;
  • 向CORDIC_WDATA寄存器写入下一次计算所需参数;
  • 当计算完成,RRDY位被置1,产生中断信号;在中断服务函数中读取CORDIC_RDATA寄存器上一次计算的结果,读取结果的操作完成后会触发下一次计算的开始;读取CORDIC_RDATA的操作会清除RRDY位和中断信号;;
  • 从CORDIC_RDATA寄存器读取最后一个结果,完成计算。
    7 F5 k1 j( ~! i8 B: J

    7 M$ p) b5 l+ I% X6 t- Q
  • $ h& ^4 ?& _7 D+ [2 J' X
  • 直接存储器访问模式(DMA mode)

    该模式下CPU占用率为0%;DMA请求不能对CORDIC_CSR寄存器进行读写操作,因此DMA模式只适用于相同模式下的运算,比如使用相同的函数、相同的缩放因子、相同的迭代周期等;DMA模式下,数据的来源与输出目的地不一定是片上内存,可以是其他外设,比如DAC和ADC;


    . ^4 _5 E& i# F- z6 L1 P. D

    ! }% Y0 m1 e6 N( Q! s5 V7 G# Z
  • 配置CORDIC_CSR寄存器,也就是初始化和配置CORDIC;在STM32CubeMX中设置DMA模式;

  • 使用CORDIC_Calculate_DMA函数启动DMA运算,入口参数中配置数据源的地址以及输出地址,并且设置DMAWEN位和DMAREN位;

    注意事项:当DMAWEN置1时会产生DMA写请求,当DMAREN置1且RRDY置1时会产生DMA读请求,因此要暂停DMA读写只需将DMAWEN和DMAREN置0即可;在DMA模式运行中应避免对CORDIC_WDATA寄存器做写操作和CORDIC_RDATA寄存器做读操作,否则可能会产生DMA阻塞。


    3 Q, b' g' \( Q7 V7 z
0 i; W8 V" }7 ]
3. 定点带符号整数数据格式(Q1.31,Q1.15)3.1 定义

在q1.31格式中,数字由一个符号位和31个小数位(二进制位)表示;数值范围是-1(0x80000000)到1 - 2^-31(0x7fffffff);精度是2^-31(大约5 x 10^-10)。

640 (2).png   p9 I6 _: Q: S5 g+ P; W7 ]; z; _
& V" G! l( h  _1 S: A
6{1P){WKOQU0ABX~1ELO1.png ; c. N& p2 i3 K

在q1.15格式中,数字由一个符号位和15个小数位(二进制位)表示;数值范围是-1(0x8000)到1 - 2^-15(0x7fff);


* I1 Q2 T. z7 p% o" A

640 (1).png 5 Y( `7 D( [! S+ l) P

6 U5 i4 l4 O( ^, k/ k 5J~BNAAMTUAV20R%J8213.png 9 y+ }; |* ^  h0 @

这种格式的优点是可以将两个输入参数打包到一个32位的数据中,并且可以在一个32位的读操作中获取两个结果;但精度降低到2^-15(大约3 × 10^-5)。

640.png 3 V, M3 g' C  x8 R% [$ z

5 l/ R+ d* I$ C4 S* W. t* S" `3.2 带符号浮点格式的转换

Q1.31或Q1.15格式对开发者而言不够直观,以下提供四条函数,可将Q1.31和Q1.15格式转换成带符号浮点数。


2 }; t) x& a; d

将带符号浮点数转换成Q1.31格式:

  1. /**
    3 F* _! v" F4 w* N8 H- i1 e: i: k- s' I
  2.   * @brief  将数据转换成CORDIC要求的Q1.31整型数据格式。
    ( m; t9 L6 ]# r: H
  3.   * @param  需要转换的数据,取值可以为负数。
    3 P) W) q, q% \. k, `* K( ]5 \
  4.   * @param  比例系数;数据除以比例系数之后再转换格式;2 i+ g  Z* x' V
  5.         *         CORDIC的输入参数数值在[-1,1]之间,故需要先除以一个比例系数。
    " o3 i; d9 s' B% H
  6.   *            @ref STM32G4 Series advanced Arm-based 32-bit MCUs - Reference Manual# M0 W) Y% _: j8 Q% X& c
  7.   * @retval Q1.31整型数据# W+ G7 ~" u- t9 n6 k
  8.   */8 {  d& B; x6 W! Q) t0 B  d
  9. int Value_To_CORDIC31(float Value, float Coefficient)+ m! C" c4 r7 l" ?$ G7 ?9 M3 a0 ?
  10. {
    9 p( C+ I' s. D8 L
  11.         int CORDIC31;- x" f* Y5 p8 j/ ~! T9 w& d
  12.         CORDIC31 = (int)((Value/Coefficient)*0x80000000);
    # I! W+ S. ]" l* H2 ]. M4 L! n
  13.         return CORDIC31;
    : b9 Q+ V( j4 `# @+ }
  14. }
复制代码

将带符号浮点数转换成Q1.15格式:

  1. /**# o  @# |0 D' ^- S
  2.   * @brief  将数据转换成CORDIC要求的Q1.15整型数据格式。/ m2 m7 ]  O( H) X6 t7 B
  3.   * @param  需要转换的数据,取值可以为负数;该数据存放在高16位。0 h, b) O& g+ P+ R: Q1 g8 ^
  4.   * @param  需要转换的数据,取值可以为负数;该数据存放在低16位。
    7 v$ p5 H# j& w1 `  `: s
  5.   * @param  比例系数;数据除以比例系数之后再转换格式;7 U# P% f; Q  v0 x
  6.         *         CORDIC的输入参数数值在[-1,1]之间,故需要先除以一个比例系数。% L$ L* n2 e3 l5 |
  7.   *            @ref STM32G4 Series advanced Arm-based 32-bit MCUs - Reference Manual/ u& Q2 X2 T% v  y4 d
  8.   * @retval Q1.15整型数据
    ; V% U5 d9 {8 U! T* @! e, \( ~
  9.   */
    + o; }9 B8 d4 l* L
  10. int Value_To_CORDIC15(float ValueA, float ValueB, float Coefficient)4 [( Z& v$ e2 K, f7 e
  11. {
    0 c2 A( s1 u7 [, t: @* B  A
  12.         int CORDIC15;' E8 A& M& K1 f
  13.         CORDIC15 = (int)((ValueA/Coefficient)*0x8000) << 16;  L; U4 ^' @( f8 |- m( D& U
  14.         CORDIC15 = CORDIC15|(int)((ValueB/Coefficient)*0x8000);" D8 ~5 s' \# S9 f! O7 a. ^& i
  15.         return CORDIC15;( B4 V; c8 c  u+ K5 B. O
  16. }
复制代码
2 M. y* o: @0 G  J) t

& B1 ?7 S9 V: E9 \

将Q1.31格式转换成带符号浮点数:

  1. /**# `7 l, E- |6 p$ Q! P9 A& O
  2.   * @brief  将CORDIC输出的Q1.31整型数据转换成带符号的浮点数值格式。
    2 F$ s( b% ?: {2 ~
  3.   * @param  需要转换的数据。
    8 q5 n8 }, M# c  j7 V
  4.   * @param  存放输出数据的地址。
    ) H5 I( A- Z" q6 P1 w6 W
  5.   * @note   转换无精度损失;
    . b' H: ~& X: R, q" a
  6.   *         精度要求不高时,可以将double类型换成float类型以节约RAM空间;此时精度将下降至1/10000000。* E0 w2 G, W- a5 R$ P! a
  7.   */7 V. g4 l$ H0 |2 ^6 n
  8. void CORDIC31_To_Value(int CORDIC31, double        *RES)* g! }) ~2 n% C! b2 s" Q" G5 B: d
  9. {. B+ D* j( ?. v% U
  10.         if (CORDIC31&0x80000000)( L: ^' k  K/ c5 f7 X
  11.         { /*为负数*/3 e, t4 y; i0 u+ n( w. R) B1 ^! g
  12.                 CORDIC31 = CORDIC31&0x7FFFFFFF;
    * R8 k) L, }! a0 F" G7 Y6 X6 L
  13.                 *RES = (((double)(CORDIC31)-0x80000000)/0x80000000);
    " N2 o2 {4 t/ Z$ C1 l5 x/ d* z
  14.         }$ ?% ^: @. j5 O3 Y4 y9 T
  15.         else% P$ P4 ?- D$ E8 w
  16.         {/*为正数*/% b, k8 K3 [; }, o7 @8 {) h
  17.                 *RES = (double)(CORDIC31)/0x80000000;2 F. A" U- E. A6 X9 E! `/ N
  18.         }
    " x; E/ z$ `. q& D2 c" K
  19. <font size="2">}</font>
复制代码

# I* o9 i) S. w9 K/ @/ Q5 Z# N
0 X3 ], O( g2 j. o6 i; g* i8 }

& [1 E" }' Y" e' N

将Q1.15格式转换成带符号浮点数:

  1. /**# u* G: K- ]' I/ a; o- m( o
  2.   * @brief  将CORDIC输出的Q1.15整型数据转换成两个带符号的浮点数值格式。8 ]- Y1 e3 ]/ j; J
  3.   * @param  需要转换的数据。
    : u4 {$ r* H3 j4 G0 P# H5 t: H
  4.   * @param  存放输出数据的地址;输出高位数据。4 J6 e& T( ?% e; H
  5.   * @param  存放输出数据的地址;输出低位数据。7 g, G+ J  E  l6 @6 Y" s: `
  6.   */9 F% v: A$ [" M" H
  7. void CORDIC15_To_Value(int CORDIC15, float *REA, float *REB)
    3 E/ z. Y1 L# ]# H: N/ q
  8. {
    % A, y: g8 `) l+ ]* C* {# H" J
  9.         if (CORDIC15&0x80000000)//处理高16位: c' @+ I8 y& \7 c  `$ i
  10.         {/*为负数*/, Z. a8 K5 O# L! Z0 ~5 N, H
  11.                 *REA = ((float)((CORDIC15>>16)&0x7FFF)-0x8000)/0x8000;2 p- K) L1 ^& a3 _  X; t1 `$ T
  12.         }
    - j$ e- c. M0 K) }" V. b& I. f
  13.         else
    9 U: ^+ l5 T9 S" s; y
  14.         {/*为正数*/0 \* @4 x% w5 U- {# R: N: w  W
  15.                 *REA = (float)((CORDIC15>>16)&0xFFFF)/0x8000;
    " p3 k4 S6 d8 \+ z: @0 [0 O
  16.         }
    2 x9 q) m' q- J# ]
  17.         if (CORDIC15&0x8000)//处理低16位
    & s# Q0 d  `5 {* m" ]5 w, e
  18.         {/*为负数*/  _9 m' u& }4 h2 {# t3 d
  19.                 *REB = ((float)(CORDIC15&0x7FFF)-0x8000)/0x8000;
    7 n) q. |" W8 R5 ], q
  20.         }* k4 @0 f# q7 E4 A& p5 w. w( B
  21.         else, X' Y0 h9 P* Q6 X6 {0 h$ V. J! c, Z6 j
  22.         {/*为正数*/2 Y# \, f1 S2 e* J! k5 u* l
  23.                 *REB = (float)(CORDIC15&0xFFFF)/0x8000;
    , n& _/ Q6 q' [/ V
  24.         }
    * U3 k. K& X+ y
  25. }
复制代码
2 a' B% L1 J: i
& M+ `- `5 t! E2 F5 J; G. e
赞 收藏 评论2 发布时间:2022-5-27 19:47

举报

2个回答
1316096865@qq.c 回答时间:2024-3-20 16:47:57

关于迭代次数有些问题,原文中“对于大多数函数,迭代周期推荐3到6周期。”,实际cordic精度在迭代20次左右时q1.15的误差才趋于稳定(来源RM0440 16.3.5图)。

1316096865@qq.c 回答时间:2024-3-20 18:16:58

<br /> <br />

补充一下,CSR寄存器的PRECISION位表示的是“迭代次数/4”,因此原文中应该是配置PRECISION为3-6,对应迭代次数为12-24次

所属标签

相似技术帖

官网相关资源

关于
我们是谁
投资者关系
意法半导体可持续发展举措
创新与技术
意法半导体官网
联系我们
联系ST分支机构
寻找销售人员和分销渠道
社区
媒体中心
活动与培训
隐私策略
隐私策略
Cookies管理
行使您的权利
官方最新发布
人形机器人运动控制、感知与智能配电
半导体创新技术与应用方向
EE架构与软件定义汽车
12V/48V 汽车智能配电(SPD)
区域控制单元(ZCU)与分区架构
关注我们
st-img 微信公众号
st-img 手机版