|
本篇内容将简要分析STM32自带的DSP库文件,其用汇编语言编写,代码执行效率明显优于C语言,ST公司封装好了了库文件,我们不必看懂其汇编代码,只要会调用接口函数即可。 1,代码分析 首先我们需要在一个已经建立好的工程文件里添加如下编译路径: 工程需要添加的文件如下图: b7 p6 ?" ~6 x k) @% O+ R* x$ E
为了产生fft变换信号,我们可以自己产生个采样信号:使用三角函数生成采样点,供FFT计算,fx = 4000 * sin(PI2*i*50.0/Fs) + 4000 * sin(PI2*i*2500.0/Fs) + 4000*sin(PI2*i*2550.0/Fs)。
/ m* P. W( ]; m 模拟采样数据,采样数据中包含3种频率正弦波:50Hz,2500Hz,2550Hz, lBUFIN数组中,每个单元数据高字(高16位)中存储采样数据的实部,低字(低16位)存储采样数据的虚部(总是为0)。) a. w! h0 ?% |& E
其中dsp_asm_init()函数的作用是产生采样信号,实际工程应用中我们使用的是ADC采样的处理值。dsp_asm_test()函数的作用是进行FFT变换,并计算各次谐波幅值。具体代码参见下面:
: Y: |- r2 D! n6 f/ L. j4 v) e- 1 /*, t, f5 J9 ~/ u1 ?9 m( ~
- 2 *********************************************************************************************************+ R% G& r: n3 Z$ g
- 3 * MICIRUM BOARD SUPPORT PACKAGE) |* x+ q) Z" u" y
- 4 ** @0 ]9 k1 x- ]7 D
- 5 * (c) Copyright 2007; Micrium, Inc.; Weston, FL5 M3 P4 L* F! X
- 6 *
% I" [! N1 J% t: g - 7 * All rights reserved. Protected by international copyright laws.' P% a* e8 }% a
- 8 * Knowledge of the source code may NOT be used to develop a similar product.
6 w- o) D! C' r) o+ l - 9 * Please help us continue to provide the Embedded community with the finest
0 H+ `+ P1 {+ A& v) d - 10 * software available. Your honesty is greatly appreciated.
F2 m R0 Z5 i3 @5 n9 \: Y0 N - 11 *********************************************************************************************************: g$ v2 J h8 A$ \6 G
- 12 */( q# `3 S U" p, l5 O
- 13
5 K/ x- w. D2 w8 P6 Z+ x& [ - 14 /*1 `1 j6 o0 L, J8 R( Q/ t9 U2 K# y& M
- 15 *********************************************************************************************************
( Y N" m o# G: Q+ Z# k! L - 16 *
$ S) F6 X! B$ ], @ - 17 * BOARD SUPPORT PACKAGE8 F; o$ _' w, g9 j8 p$ r
- 18 *0 ]1 _2 R* C7 C. Q1 ]
- 19 * ST Microelectronics STM32; v, \3 B8 R( L. g t
- 20 * with the7 L- k! L+ s! m+ R) i
- 21 * STM3210B-EVAL Evaluation Board V ^5 G( o3 t, n
- 22 ** f7 _+ w f! L4 f! e8 b
- 23 * Filename : bsp.c+ `" ?% ]0 z9 g1 k8 O/ u7 M
- 24 * Version : V1.00$ b: ~ e+ r7 l- h7 r
- 25 * Programmer(s) : Brian Nagel C, D4 l0 D& w
- 26 *********************************************************************************************************
3 I$ a: h3 L$ Q- V - 27 */
, K3 V _- B+ ]# A0 _ - 28 ( W8 K R/ x- c( q* _) l, N
- 29 /*8 \ G* S. r, p/ F
- 30 *********************************************************************************************************
" D0 Y3 e6 ?: r: H0 t1 w - 31 * INCLUDE FILES
0 A7 D0 b+ q( x1 N" p( L - 32 ********************************************************************************************************* J/ E4 s1 k+ G/ {- V
- 33 */
& B4 l" w' v- \* {! S - 34
! j5 o. Q6 a0 ~7 k - 35 #define DSP_ASM
0 ^: d, X3 J9 t ^6 t! g - 36 #include "stm32f10x.h"
) N6 H/ I4 f% y, T1 Z2 | - 37 #include "dsp_asm.h"; C" e3 x8 z5 G2 e" c0 R% d
- 38 #include "stm32_dsp.h"# o( U' U' |0 m
- 39 #include "table_fft.h"1 }# D Y- R1 l
- 40 #include <stdio.h>6 p$ C7 J: d8 n. X6 ~( n
- 41 #include <math.h>4 C: c R* @$ [+ e! h3 K
- 42 / r! \3 R0 x5 Z8 i, s+ q0 z, B; r
- 43 % e+ f( J* M7 m8 G, Q
- 44 /*
3 |$ b) Q: q/ T; h8 N - 45 *********************************************************************************************************
O# P+ d. X- U. N8 |4 v* K- x2 ^2 S - 46 * LOCAL CONSTANTS
& j% u! D: R& b - 47 *********************************************************************************************************9 ~" ^% f3 Y1 ^; L/ H
- 48 *// b& |' j9 n) j
- 49 #define PI2 6.28318530717959
) Z. j0 ]( l$ ^8 W! @. X0 X4 p - 50 #define NPT_1024 1024
% x: w! B; N# q/ _; W% s4 N- o - 51 //#define NPT_256 2565 d1 O1 l9 x$ i& z' n/ d
- 52 //#define NPT_1024 1024
3 P7 Y, `* g# i, k! U. H& n) x3 B - 53
, ^) k0 O. G8 s: `- Z) i7 m# A - 54 // N=64,Fs/N=50Hz,Max(Valid)=1600Hz
, C0 E& S/ {4 g - 55 #ifdef NPT_64
( [, F. W: H" m3 T - 56 #define NPT 645 m& v) Y& N; i9 r' I
- 57 #define Fs 3200
8 x: {& x4 {. O - 58 #endif
% C( h; a# y5 t$ S) e+ f - 59
4 x8 H9 |& ]" z - 60 // N=256,Fs/N=25Hz,Max(Valid)=3200Hz4 z7 u+ f3 Z V
- 61 #ifdef NPT_256
. o: W0 \4 z% K4 n$ \7 }$ i - 62 #define NPT 256
( r1 A1 P% Q& d" ]/ i) B - 63 #define Fs 6400! W6 q" S ~- O. S7 R
- 64 #endif
[4 C2 `; j4 m& x9 R2 O2 | - 65
: l0 L1 b5 n* v6 a - 66 // N=1024,Fs/N=5Hz,Max(Valid)=2560Hz' q1 g$ X. |' N/ g
- 67 #ifdef NPT_1024
9 K# f. w& G! k - 68 #define NPT 1024" K. O5 p# Q8 C
- 69 #define Fs 5120
6 k$ ]" N/ ]" _" a - 70 #endif3 Z. _# g7 Q+ M$ O8 F# g4 o
- 71 7 H4 J/ J, _& `! u: r
- 72 " L, W' ~/ X) v, P- G
- 73 /*6 I3 Y# O6 s. R6 G
- 74 *********************************************************************************************************
$ R' v1 H, c% w" Q( I - 75 * LOCAL DATA TYPES
' Z, h* d+ r& j0 c - 76 *********************************************************************************************************5 x6 _1 M) w) @; c. z
- 77 */, s- Z7 o, f# a4 [7 R! K
- 78
" \; n: U9 P3 P, e, t - 79 , a" Q$ H) q. z" g3 s
- 80 /*$ S- x) S" X( ^
- 81 *********************************************************************************************************! o8 y5 U+ x2 a5 z( M
- 82 * LOCAL TABLES
& ^8 e; y9 A, r# w - 83 *********************************************************************************************************+ T, T: Q7 i I0 S1 Q
- 84 */7 I2 D- C8 A6 U
- 85
6 C* O) n- s* i% x - 86 / G* z& q, z( H/ ^
- 87 /*8 f1 O% s; k1 ` x
- 88 *********************************************************************************************************
; [, e2 \% t+ S - 89 * LOCAL GLOBAL VARIABLES
( _2 w& G: G; k6 E - 90 *********************************************************************************************************
$ C7 C- D ^ W1 k# |9 ^ - 91 */
+ k* T* V o. k) H: C - 92 long lBUFIN[NPT]; /* Complex input vector */
/ l. L+ v5 d! @+ I- n - 93 long lBUFOUT[NPT]; /* Complex output vector */
, _* \* e' W: Z3 S& y3 [2 Q - 94 long lBUFMAG[NPT];/* Magnitude vector */9 H* x$ H# q0 h$ b5 s5 d
- 95 /*
% q- D) s% F8 }; k - 96 *********************************************************************************************************$ o8 [1 t. l# [9 y" w% ~3 Y
- 97 * LOCAL FUNCTION PROTOTYPES
0 M* }1 K! J V7 z! B/ L4 ~ - 98 *********************************************************************************************************
; n4 H. i/ _- p, K$ ` - 99 */
0 q9 r( L4 {+ @/ j2 [ - 100 void dsp_asm_powerMag(void);# I' U3 }4 t. I2 u5 e* H) k* u
- 101 : P) g4 E H, ^3 t4 g- R
- 102 /*
3 A- v, s+ q+ V5 ~; K2 y - 103 *********************************************************************************************************
$ C h0 s. _ w* b6 l% y5 k* J - 104 * LOCAL CONFIGURATION ERRORS
" p' y# J6 a& Q, a( f) i - 105 *********************************************************************************************************
3 e/ q; p0 X6 [# D! T; h - 106 */1 w6 D6 ^- W6 @/ D i
- 107 4 H/ D* \' r# Q% x) o# `
- 108
2 b z+ K3 C: N: ` - 109 /*$ A/ C7 ~* P0 [/ Z: Y, ?
- 110 ******************************************************************************************************************************
5 D; y8 I/ c: O; ]4 ]: s - 111 ******************************************************************************************************************************
' m2 A: w3 ]- w - 112 ** Global Functions" Q6 o S v) H$ c
- 113 ******************************************************************************************************************************
8 b. ~ w' c3 M Y5 p l0 c - 114 ******************************************************************************************************************************; Z a6 b. f7 A1 E9 B
- 115 */
/ X. n& q& y. Z" H, X& X% H - 116
) ~3 S+ p! P' ]4 Z2 T6 a: J! X; n - 117 void dsp_asm_init()7 t6 L/ |( X3 |! Y2 o2 O* A
- 118 {
; k$ o8 y' e- S/ N) g) \2 C7 L - 119 u16 i=0;
$ r# k* S# f A) O6 d3 r2 o* \6 H" q - 120 float fx;
# B# h% D: Z) K2 V7 K. K - 121 for(i=0;i<NPT;i++)
1 d/ I0 ^3 S$ u9 E- r/ B2 u# V0 d: G - 122 {( _& A# c, z: w+ Y9 d3 O# }8 P7 O1 n% E
- 123 fx = 4000 * sin(PI2*i*50.0/Fs) + 4000 * sin(PI2*i*2500.0/Fs) + 4000*sin(PI2*i*2550.0/Fs);& B' G, N' E5 ~$ d8 y( l
- 124 lBUFIN[i] = ((long)fx)<<16;) T% u: ?: q7 I5 W. u+ ?5 t F
- 125 }
% _0 m& |' Z: b2 f - 126 }
6 t( @2 |& m, b - 127 2 I# w, k9 v! U1 ^6 @; W% Q) q% f
- 128 void dsp_asm_test() 6 e G, E& }) x" C) G3 C$ b" ^
- 129 { ~; r5 M* ^" y) q# n
- 130 & }$ y: t8 b* P$ s8 l$ R) o
- 131 #ifdef NPT_64
; C& G8 t9 f, P/ d7 A* c - 132 cr4_fft_64_stm32(lBUFOUT, lBUFIN, NPT);7 B: o4 K' a+ b" V7 n+ b
- 133 #endif
& U ?! e7 Z; ^. W0 g3 p - 134
2 { d8 A" l1 s6 c8 e6 Z6 m - 135 #ifdef NPT_256/ W8 ^1 F$ |# A- H; X, I1 X
- 136 cr4_fft_256_stm32(lBUFOUT, lBUFIN, NPT);
0 ]7 _8 K8 y/ T( l* A - 137 #endif
; i" M ^: P3 A - 138 4 s* ?7 l2 K- J9 z1 T; U
- 139 #ifdef NPT_1024
. A- ?4 c$ d: p; D: d: k- n - 140 cr4_fft_1024_stm32(lBUFOUT, lBUFIN, NPT);2 j* T$ Z" w' G8 }
- 141 #endif
& s/ n# h- H g, Z, i- L* o1 k - 142
; y' _" H" E, {! A$ F3 O: Y - 143 // 计算幅值
4 h8 A4 \: n$ x. p - 144 dsp_asm_powerMag();
3 b/ L! [8 Q+ p. }* J$ @! c - 145 2 Z/ e# a9 `1 Z2 k: j( A( `
- 146 }
& K9 X9 Y u2 p0 ^0 D0 q - 147
( P. @' ]. a6 M* G, b. k - 148 void dsp_asm_powerMag(void), h6 \0 w% d, @# i) i
- 149 {
' i& q8 q; m$ [( N0 c - 150 s16 lX,lY;
/ A" T$ [) ?# m" ]7 B4 h. j+ S* y, S - 151 u32 i;
* S6 m- s9 @' E Z4 a' J5 L+ d% b8 Z - 152 for(i=0;i<NPT/2;i++)
& ?6 p6 l3 @ g4 t- q9 F - 153 {
3 }; n, }, B: u" c8 N: i - 154 lX = (lBUFOUT[i] << 16) >> 16;; L1 M: J2 g8 H1 n% A- }: O
- 155 lY = (lBUFOUT[i] >> 16);
' h% [; U' u, G0 t- v% S - 156 {
! x. s& J9 W4 y2 D( S& `# U - 157 float X = NPT * ((float)lX) /32768;- C" `/ }% g2 d- v! }
- 158 float Y = NPT * ((float)lY) /32768;
2 Z- z2 R7 u! y, X9 A0 k! z) K - 159 float Mag = sqrt(X*X + Y*Y)/NPT;
1 j, D- P, l$ @+ d - 160 lBUFMAG[i] = (u32)(Mag * 65536);
" o: `" G% b3 ]' A4 \2 T - 161 }* U/ Q1 k0 P8 ?6 G; u
- 162 }
% t9 V5 j# X* g! J6 A( ?- z - 163 }
复制代码- 1 /*
: E1 t7 M2 m( M6 ~' h- u; I - 2 *********************************************************************************************************
1 z8 v8 \( E4 A& b3 I# w0 d: u' w - 3 * MICIRUM BOARD SUPPORT PACKAGE
& k/ ^+ H w5 g7 L - 4 *
/ q, u3 h, N( p/ B `! a/ o - 5 * (c) Copyright 2007; Micrium, Inc.; Weston, FL! k& p( Q, i/ n9 h) \
- 6 *
6 v1 ?- n1 z' @# @ - 7 * All rights reserved. Protected by international copyright laws.
3 B: b7 h# F& a+ S4 \/ C: [ - 8 * Knowledge of the source code may NOT be used to develop a similar product.- ~; F" k$ W' V5 [& K" f+ R5 u
- 9 * Please help us continue to provide the Embedded community with the finest
0 v1 P" a' T4 G- v6 H1 { - 10 * software available. Your honesty is greatly appreciated.
3 q) U$ q5 b( y" ]: u - 11 *********************************************************************************************************
. s) M6 C5 W* G% Q" t - 12 */( n9 I0 C6 t; m7 q$ f% T
- 13 % o) ~. d- p( x9 X% S
- 14 /*
9 A4 R+ Y- \* Q9 t& N - 15 *********************************************************************************************************
' E- e; J5 A7 q* Y6 n3 }" i - 16 *
& m1 g5 j1 v9 @+ l' Q8 s+ B - 17 * BOARD SUPPORT PACKAGE% G: J! v+ s/ Z% Z% U$ K3 y9 a x
- 18 *
8 p% L Q- ?4 {, s$ `. G1 A - 19 * ST Microelectronics STM32
+ H/ i Q6 A- H0 l) L8 k - 20 * with the" D( e: W9 h G% `/ i6 Q
- 21 * STM3210B-EVAL Evaluation Board
0 q( N6 O! J0 o4 @! W/ c - 22 *
8 E0 R3 y6 n# I. [. C - 23 * Filename : bsp.h
+ s$ n( m- Q9 q% u K - 24 * Version : V1.00" C; O) y' }4 n5 |' R* K4 g5 g
- 25 * Programmer(s) : Brian Nagel
, ^# Z- k2 h, x5 }9 E - 26 *********************************************************************************************************9 f# E& {9 `" ?8 [1 N* H0 U
- 27 */
H1 }6 @- t" g( h - 28
* c P) K+ ~* n8 R6 M* _ - 29 #ifndef __DSP_ASM_H__7 ^5 u8 X9 K% `. c h7 G Z) y
- 30 #define __DSP_ASM_H__
2 }9 o' v e0 K6 z - 31 , }2 j" Y p" {1 S+ J9 m! o; {0 U7 u9 P
- 32 /*
5 P @; V! U# g5 A+ j1 X, L( \+ O - 33 *********************************************************************************************************
5 {, f4 W/ v# w4 r8 { - 34 * EXTERNS2 x+ Z" [# F# k5 K+ `! J4 S8 Z
- 35 *********************************************************************************************************
* [" p5 O5 N! b) ~/ n - 36 */* |% {. Q/ [; H( \3 C" W
- 37
( Z! e) \" r1 L* J O) C2 y( I - 38 #ifdef DSP_ASM
4 f- o+ X7 W N9 F5 N9 [ - 39 #define DSP_EXT4 b4 u) B2 }5 i" V+ I; d' ]
- 40 #else& Z3 A0 l! J1 @6 k
- 41 #define DSP_EXT extern& @3 e' S6 m& B2 q- `8 [% X
- 42 #endif) W9 h: l& y8 z* U" R, I
- 43 5 m5 Q* Z+ F. C4 m
- 44 /*
! ?- i4 g" E7 j) u - 45 *********************************************************************************************************4 \; r' F: B3 b$ g' u! i: C' A
- 46 * INCLUDE FILES
( E/ B& A1 w/ _8 Y% d& G" j - 47 *********************************************************************************************************1 o" |* J! p% `
- 48 */* z# S: u# l) M9 @/ r
- 49
( R' A* y8 v1 X - 50 . x5 s: N3 m5 T* X0 B8 e0 R/ y" D
- 51
5 Y% @8 ?( V" N; c; j ^ - 52
( K& h0 n; w" W! v! Y9 b( Z; t - 53 /*
z$ d4 E6 v5 J' A* {: b - 54 *********************************************************************************************************- b) C; \* D/ G' u
- 55 * GLOBAL VARIABLES
4 R6 n9 E4 ^- k1 x( T! q$ m - 56 *********************************************************************************************************" ~1 u5 R- A9 {
- 57 */
8 I% _- C( O m - 58
) n0 Z- M8 l. n. A& M% K, i - 59 2 f! X7 }$ j7 U5 A
- 60 /*& [4 ~8 T8 O: P+ q; F( e2 A
- 61 *********************************************************************************************************; D" E8 w4 A' P1 B
- 62 * MACRO'S, d$ ^, w1 a$ B
- 63 *********************************************************************************************************) Z0 \5 u. r G0 w" R6 K
- 64 */
$ z" L4 C8 Q$ s V$ L9 U g - 65 " f" Z6 b+ ~! Y D9 P0 C
- 66
- f; u! ~' {! _' `6 ~% U% {( { - 67 /*5 d6 @" I+ m z8 p3 s
- 68 *********************************************************************************************************9 p9 b9 N( h/ Q" K, P9 b+ G
- 69 * FUNCTION PROTOTYPES
& C* \$ ^; M6 P/ O' `7 K - 70 *********************************************************************************************************
# k3 H0 l; ~0 G - 71 */
9 o8 T9 m! p0 `$ }/ ^ - 72
7 H! u9 u; |3 ~# L! h, s - 73 void dsp_asm_test(void);
5 m; w" [* ^* o# O# d: i - 74 void dsp_asm_init(void);
, L/ N7 g8 ^1 |4 x2 O& \# T8 A) q - 75 . Z0 S) m |) ^$ T! D; x# O
- 76 #endif /* End of module include. */
复制代码
7 i& A# W7 _3 G9 D: O8 M" V8 @ 着重分析下dsp_asm_powerMag()函数的作用,其函数就是求幅值,首先定义的的一个16位的有符号的数据IX 和IY 这两个只是中间变量,然后定义的i,是32位的无符号型。语句的目的是Mag = sqrt(X*X + Y*Y)/NPT。但直接这么写不符合DSP的计算习惯也就是不符合浮点运算的习惯。因此语句在for函数i写道 lX = (lBUFOUT << 16) >> 16 就是取32位的i的低16位数据,lY = (lBUFOUT >> 16);是取高16位数据。下面的两句( c ~- e( b# d2 z. P8 |
float X = NPT * ((float)lX) /32768;
- n X% d8 E& [/ }, k+ V) ]) o9 o float Y = NPT * ((float)lY) /327684 k& l3 k$ J$ a
目的就是把数据浮点化,至于为什么是除以32768 。可以这么说,浮点化就好像10进制里面的科学计数法。32768=2的15次。除以32768也就是去除了浮点数后面的那个基数,只剩下前面的。比如1991 改写成1.991*10的三次幂,再除以10的三次方,只剩下1.991,便于余下的运算。至于最后一句要乘以65536是因为我们定义的数据和我们需要求得的数据都是无符号32位的,之前已经把32位的数据拆开又分别浮点化了又开了个根号,所以再把它变回来 只需要乘以2的16次,也就是65536.比如说问你什么时候生日,你说是19911030,然而DSP是不习惯这么干的,他需要把它拆开为1991和1030。再写成1.991x10的3次方和1.030x10的3次方。然后才能进行其他的运算。) `. G% H% t5 `& m5 s2 d
这里是ST公司采用了DSP专用芯片(主要是指TI)的写法,也就是说尽管DSP的芯片类型很多,数据变量的定义也各有差异,但原理是一样的,最终还是要采用DSP习惯的运算方式。至于为什么一定要采用浮点运算,因为机器是傻子,然而TI公司的工程师是天才。 main函数中我们只需在while(1)前加上dsp_asm_init(); dsp_asm_test();即可。& ?+ ^) U2 p: V
2,实验现象 注意FFT运算结果的对称性,也即256点的运算结果,只有前面128点的数据是有效可用的。 ① N=64,Fs/N=50Hz,Max(Valid)=1600Hz,64点FFt,采样率3200Hz,频率分辨率50Hz,测量最大有效频率1600Hz 64点FFT运算结果图(局部): 上图中,数组下标X对应的谐波频率为:N×Fs/64=N×3200/64=N*50Hz. lBUFMAG[1] 对应 50Hz谐波幅值。 上图中由于FFT分辨率50HZ,最大只能识别1600Hz谐波,导致结果中出现错误的数据。 ②N=256,Fs/N=25Hz,Max(Valid)=3200Hz,256点FFt,采样率6400Hz,频率分辨率25Hz,测量最大有效频率3200Hz
+ r% C4 ?; Z- W; n- V' X, ~/ J256点FFT运算结果图(局部): 上图中,数组下标X对应的谐波频率为:N×Fs/256=N×6400/256=N*25Hz. lBUFMAG[2] 对应 2×25 =50Hz谐波幅值 lBUFMAG[100] 对应 100×25=2500Hz谐波幅值 lBUFMAG[102] 对应 102×25=2550Hz谐波幅值 ③N=1024,Fs/N=5Hz,Max(Valid)=2560Hz,1024点FFt,采样率5120Hz,频率分辨率5Hz,测量最大有效频率2560Hz 1024点FFT运算结果图(局部): 上图中,数组下标X对应的谐波频率为:N×Fs/1024=N×5120/1024=N*5Hz. lBUFMAG[10] 对应 10×5 =50Hz谐波幅值 lBUFMAG[500] 对应 500×5=2500Hz谐波幅值 lBUFMAG[510] 对应 510×5=2550Hz谐波幅值
8 [( R ~5 j$ B$ m 总结:该工程中模拟信号源为:4000 * sin(PI2*i*50.0/Fs) + 4000 * sin(PI2*i*2500.0/Fs) + 4000*sin(PI2*i*2550.0/Fs)。 信号为1个50Hz、1个2500Hz、1个2550Hz的正弦波混合信号,幅值为均为4000。 f3 F: _2 ~ {# [7 ^: i$ q+ ?
|