|
本篇内容将简要分析STM32自带的DSP库文件,其用汇编语言编写,代码执行效率明显优于C语言,ST公司封装好了了库文件,我们不必看懂其汇编代码,只要会调用接口函数即可。 1,代码分析 首先我们需要在一个已经建立好的工程文件里添加如下编译路径: 工程需要添加的文件如下图: 
+ q5 n9 \& }' @/ r 为了产生fft变换信号,我们可以自己产生个采样信号:使用三角函数生成采样点,供FFT计算,fx = 4000 * sin(PI2*i*50.0/Fs) + 4000 * sin(PI2*i*2500.0/Fs) + 4000*sin(PI2*i*2550.0/Fs)。9 j# `) u6 ]9 D: K; C$ j2 A- K
模拟采样数据,采样数据中包含3种频率正弦波:50Hz,2500Hz,2550Hz, lBUFIN数组中,每个单元数据高字(高16位)中存储采样数据的实部,低字(低16位)存储采样数据的虚部(总是为0)。
$ J* F/ x: h; [1 o 其中dsp_asm_init()函数的作用是产生采样信号,实际工程应用中我们使用的是ADC采样的处理值。dsp_asm_test()函数的作用是进行FFT变换,并计算各次谐波幅值。具体代码参见下面:) G! ?- @, q2 |0 t5 k4 g6 ]
- 1 /*% `# j z) }: r7 c
- 2 *********************************************************************************************************
U3 W3 w9 V4 z - 3 * MICIRUM BOARD SUPPORT PACKAGE$ N+ K1 @/ {3 J* h
- 4 *
1 _+ T2 }% G y/ g, |5 v9 J+ ~: V - 5 * (c) Copyright 2007; Micrium, Inc.; Weston, FL
: z2 `9 r, `1 q8 q7 Y+ T% u0 s - 6 *
: ^5 E& o& ?' U - 7 * All rights reserved. Protected by international copyright laws.
& H( H6 l) O. e1 C4 L( M* d( F - 8 * Knowledge of the source code may NOT be used to develop a similar product.
w) ~5 r4 {1 Y, a% t1 \8 P - 9 * Please help us continue to provide the Embedded community with the finest) W7 [+ n0 }3 v! s" f1 {8 G
- 10 * software available. Your honesty is greatly appreciated.2 _" m' @$ O+ S6 P( ^2 }1 l% c
- 11 *********************************************************************************************************
+ ^" Q/ C: g$ Q" Y# a3 x' e - 12 */
% l( B& A( [- q: B9 ? - 13 4 ]" z( u% l2 n- D1 l" H. e
- 14 /*
+ S2 F! c% H p9 x! H8 x, ]$ ^3 H - 15 *********************************************************************************************************
0 E$ P: V- U( ]. G' l5 `% e* U - 16 *1 I8 L( v) p: p8 k) F* Y6 Z! T
- 17 * BOARD SUPPORT PACKAGE
. M& P9 \ c6 i; k - 18 *8 O. s0 s; L2 v3 T$ j
- 19 * ST Microelectronics STM32
0 c9 b: O2 D9 x3 Z - 20 * with the1 M3 G8 S8 s! v+ x+ ?# X$ C
- 21 * STM3210B-EVAL Evaluation Board( q" z+ j8 M! s" B
- 22 *# K; g2 s0 L" D0 S: A
- 23 * Filename : bsp.c3 T3 e2 @! O' O& W
- 24 * Version : V1.00( Z! ]2 Z/ \' j" h; ~' ^8 {) \5 l5 r* r
- 25 * Programmer(s) : Brian Nagel
6 g4 o' v5 W- k: Z - 26 *********************************************************************************************************) i% T3 ~6 K( H* b' g$ y
- 27 */6 _ o) c; |; x# U/ z0 |4 N* j
- 28 : M9 g7 n( U8 l( u, T" j" V
- 29 /*9 E. L7 h' O. @' |* F# s8 Q$ a* i
- 30 *********************************************************************************************************
2 |& ^- k& B6 U) M/ ?. n - 31 * INCLUDE FILES% O& e9 b) q, T; i: D3 u# v/ P
- 32 *********************************************************************************************************
- o7 x& w! X" o2 L: O - 33 */
: S7 k& Y4 n1 P - 34 / |8 A% E5 \+ B
- 35 #define DSP_ASM
?. W$ M J0 ~. q$ V- L' @ - 36 #include "stm32f10x.h", x+ O5 ` g" B# s- l
- 37 #include "dsp_asm.h"6 c; A0 o' q1 o$ ?% Q
- 38 #include "stm32_dsp.h"+ ~ |5 m, u* F7 \9 P
- 39 #include "table_fft.h"
! N2 q9 M6 D' ~; c - 40 #include <stdio.h>
n% p# c. u* h: z1 i3 N- m& x - 41 #include <math.h>
9 r8 _: J5 i: i% m- z: k - 42
9 Q" }# b! f: n5 r1 M - 43
9 R4 b0 K6 a! S |, W, ]1 F% d - 44 /*4 V+ b) N" |1 z# A0 \0 o1 Q
- 45 *********************************************************************************************************4 L. x2 X2 } H3 y
- 46 * LOCAL CONSTANTS
+ |' R! u3 v. b; D \ - 47 *********************************************************************************************************
9 }# N( w+ H# m - 48 */% y: |+ U1 I6 ]/ B5 G, X+ Y, D8 P% @+ Z
- 49 #define PI2 6.28318530717959 S( q/ c! a v2 E
- 50 #define NPT_1024 1024, \. r9 C9 V0 h. j
- 51 //#define NPT_256 2562 n( n0 r5 X7 m. ?. U0 I
- 52 //#define NPT_1024 1024
5 J- E; `# d d - 53
0 M8 |- d3 i6 O) k1 O. t5 ? - 54 // N=64,Fs/N=50Hz,Max(Valid)=1600Hz; X, V( L6 ?0 D2 I6 a9 i- `$ I# Q
- 55 #ifdef NPT_64
3 b& T' H' w* r) G - 56 #define NPT 64
+ [1 [: R9 s" h- N! @. }1 V1 x% B - 57 #define Fs 3200
" N1 |8 ^4 L$ A7 x# n d5 d - 58 #endif; A6 p9 K U( ]" v
- 59 ) _) O) j/ } C5 J d/ R! a
- 60 // N=256,Fs/N=25Hz,Max(Valid)=3200Hz# }' |8 v3 T; h. y* E7 q+ J2 D
- 61 #ifdef NPT_256
! s3 [, {; c. U% C% A$ |7 X+ o - 62 #define NPT 256! [! s& v7 u& K4 p
- 63 #define Fs 64009 S+ [6 O4 }' }) P2 Y9 |; t
- 64 #endif
7 o+ L% r8 W) w' z1 o- p7 Y - 65
' {# f! N9 z% G/ i; B5 c - 66 // N=1024,Fs/N=5Hz,Max(Valid)=2560Hz1 W) S; k% i7 J6 u. |. U
- 67 #ifdef NPT_1024+ \/ {; Y2 P) O3 p" M R
- 68 #define NPT 1024
4 v& t$ Q, p8 O! G( u- B - 69 #define Fs 5120" j: I- i ~: \* n$ g9 d
- 70 #endif
: _& B( G7 H8 e - 71
, d& p: V+ l# n - 72 0 M! v* P. \% \" ]) J4 N( c- X$ {
- 73 /*
9 x, i: l% ^" A$ Y% F' A - 74 *********************************************************************************************************+ G8 E/ ~ f& h. F- x3 A
- 75 * LOCAL DATA TYPES
$ S s7 y" h* b% }7 e& o U F - 76 *********************************************************************************************************
- r) _+ {5 |- ]* i( k - 77 */
C5 I' {0 K. Z# z3 J$ C* c' t - 78 8 I. k _3 e! ?* v7 s( @% S+ l0 J
- 79
7 o9 }* M/ Y2 P8 `, k - 80 /*
+ k2 ?4 v2 e. i+ N0 d - 81 *********************************************************************************************************
; E# T; \' L4 U& a, n% N - 82 * LOCAL TABLES2 f3 K( |# @" p' i4 y7 Y2 }' j. f
- 83 *********************************************************************************************************
1 w, y1 n: |3 |2 b8 q9 z - 84 */
& s: c+ v) G4 J5 v0 T+ N: D - 85
A! O* i7 G" `2 U- [ - 86 ) F; q: ~5 n$ b6 V* i
- 87 /*7 C9 _0 q' x' k0 ^2 } _4 G1 q
- 88 *********************************************************************************************************
! Y) [, m0 _0 n! c5 S0 N2 j - 89 * LOCAL GLOBAL VARIABLES+ ~4 i8 N. t9 Y+ s5 v
- 90 *********************************************************************************************************( f' {3 ~! `* n; m8 @9 H: J: K
- 91 */
8 M/ E" |7 ^6 x - 92 long lBUFIN[NPT]; /* Complex input vector */
; p1 }6 }! r4 A- U; h - 93 long lBUFOUT[NPT]; /* Complex output vector */, t' `( J, B3 b' n& h1 K$ Q/ l+ a
- 94 long lBUFMAG[NPT];/* Magnitude vector */
, m7 A7 a/ F( j; ?- y, Y - 95 /*
5 y4 ]& A. C3 l7 a$ }" `( B: N - 96 *********************************************************************************************************
( J: H/ l! V# G. X) h3 W0 o& q! F - 97 * LOCAL FUNCTION PROTOTYPES( M' ^4 l7 e7 O/ b
- 98 *********************************************************************************************************
9 H* n: @) E1 \% [5 U: d! [ - 99 */* O4 E7 F$ ?# l! d A3 Q
- 100 void dsp_asm_powerMag(void);
$ Q+ @. m& U: x, i q. l( S* U - 101 ; ^3 a$ d3 a- i
- 102 /*
( n6 V' r: l0 D8 a7 \8 s$ |! x - 103 *********************************************************************************************************1 h. G3 n% t! f
- 104 * LOCAL CONFIGURATION ERRORS
2 H" k. Q& j* z8 z - 105 *********************************************************************************************************2 {0 p. m6 x% N5 x
- 106 */
( C: Z) K$ h( h2 r/ P6 v+ { - 107 0 h5 m- S, E, J; w. \* m
- 108
* G. M2 b( l4 r& w - 109 /*% B4 t" n9 X0 I$ r
- 110 ******************************************************************************************************************************
- C) v4 T( F$ e7 N- G T - 111 ******************************************************************************************************************************
. r. C5 M$ N+ R8 t - 112 ** Global Functions: h9 n3 j U, o; n! ~
- 113 ******************************************************************************************************************************
" Q( T: ]' C0 ~ - 114 ******************************************************************************************************************************
7 j! p H3 @* J' A# g" u1 W - 115 */
' }; ?: v5 _ D4 t' t4 c, O - 116
+ l8 O8 U! V" Z% W' U8 Q; j) q+ k - 117 void dsp_asm_init()8 f/ l7 j% H: B$ M3 d
- 118 {
: z$ r: ~2 |' \ - 119 u16 i=0;" d2 c+ I: \% f# K% e
- 120 float fx;
% l3 J- h7 ^' F* B - 121 for(i=0;i<NPT;i++)
0 K. ]% h- Z9 F - 122 {( Y# Y2 h/ I- a9 P8 h
- 123 fx = 4000 * sin(PI2*i*50.0/Fs) + 4000 * sin(PI2*i*2500.0/Fs) + 4000*sin(PI2*i*2550.0/Fs);4 C0 x4 P4 \# ?% z4 g$ X9 f/ l4 y- ?
- 124 lBUFIN[i] = ((long)fx)<<16;
# @+ m* g: t; x" P0 W - 125 }6 ?7 o9 e! |/ O
- 126 }/ \ X( ~9 G3 t
- 127 * A2 ] e: ]5 q$ O4 V. D3 n
- 128 void dsp_asm_test()
( T" K% j& F k- k9 g& ] - 129 {7 U" ^' r/ u& s
- 130 : R0 K( T- W& C8 g; U( \
- 131 #ifdef NPT_64
4 D. U/ H' Z5 t - 132 cr4_fft_64_stm32(lBUFOUT, lBUFIN, NPT);
! v) Q1 w% x* Z1 u- b3 J - 133 #endif( I- p% b6 [0 z7 q7 X$ `
- 134
& H% o+ } P* P9 `4 Z - 135 #ifdef NPT_256
5 j; O2 S' H1 T( O! i: F - 136 cr4_fft_256_stm32(lBUFOUT, lBUFIN, NPT);
7 r( Y5 A+ m7 n& q - 137 #endif/ s- p/ t! ?+ Z' Y- ?: H
- 138 7 G, `. A4 ?) J$ r! Z
- 139 #ifdef NPT_1024
1 q$ t* H: A0 S% e4 Y - 140 cr4_fft_1024_stm32(lBUFOUT, lBUFIN, NPT);7 i' l3 Q7 c! w, z
- 141 #endif
' O9 [2 ~) N: T4 l$ r - 142 8 W8 H: H2 M( M9 t5 L1 `
- 143 // 计算幅值
* x* p: w z/ O4 U) a4 d - 144 dsp_asm_powerMag();: ?1 V' V1 P/ E, p& C+ u' T+ p8 ^/ d
- 145 1 Z" j+ J( W7 j
- 146 }' ~5 c9 u& F; d3 Z+ \( v* X
- 147 % l" Q6 ?2 s o: j
- 148 void dsp_asm_powerMag(void)2 p2 [6 {4 H8 ]7 o! \' Y
- 149 {* z! D, m9 ~) Z. A* d; S
- 150 s16 lX,lY;/ f- q- W6 ?$ n; K9 A
- 151 u32 i;7 f7 M9 r1 x/ A+ }; O0 y/ d
- 152 for(i=0;i<NPT/2;i++)+ O3 S1 a5 G7 g* j. o0 |, T
- 153 {$ }, W* `2 b' K+ Q l
- 154 lX = (lBUFOUT[i] << 16) >> 16;, v# y9 V; _! e; p/ l L
- 155 lY = (lBUFOUT[i] >> 16);
% _- c7 z( l, A- E+ ?: p - 156 {. p+ V) w* `' b: p$ p! K+ }: R
- 157 float X = NPT * ((float)lX) /32768;
7 k/ P' T$ g! g - 158 float Y = NPT * ((float)lY) /32768;9 Z6 { U! ? p; b
- 159 float Mag = sqrt(X*X + Y*Y)/NPT;
# q6 [: e% l" p - 160 lBUFMAG[i] = (u32)(Mag * 65536);/ v4 U0 ^3 M' ~5 {1 [2 p
- 161 }3 A' A) ?" _, b* `" k# [5 v
- 162 }7 W* g( c( z& H% v, g8 z7 q
- 163 }
复制代码- 1 /*
( E, C& U8 k8 o - 2 *********************************************************************************************************
0 m! q Q) S- ?3 @# I `' ` - 3 * MICIRUM BOARD SUPPORT PACKAGE$ s3 E/ b* |% ~2 O: F( m: W2 b0 V) R3 Z
- 4 *
# G$ U3 f7 k+ F" \5 [% t2 N$ w - 5 * (c) Copyright 2007; Micrium, Inc.; Weston, FL8 v$ r# g/ R5 @
- 6 *5 Y9 D% t R- j& w2 X
- 7 * All rights reserved. Protected by international copyright laws.) B7 K% ^: m, V# p# Q* b9 q! E
- 8 * Knowledge of the source code may NOT be used to develop a similar product.# e7 w* x9 l$ `7 W
- 9 * Please help us continue to provide the Embedded community with the finest
5 h( B: E# T: U, M1 {" s/ X - 10 * software available. Your honesty is greatly appreciated.
, P6 G1 [4 n; p1 ]: o" D& ^ - 11 *********************************************************************************************************' B9 x! ?( g) {1 I0 d' A7 L- R
- 12 */
/ Z# j2 e4 B) k( u - 13 5 `2 |. S" H6 H# V2 d! c) S
- 14 /** K! n g/ E3 `' b/ V: S3 G
- 15 *********************************************************************************************************' A1 }. q. }% n2 v2 ~
- 16 *
. |& o7 d% c5 ?: e! K1 a. t' [& ` - 17 * BOARD SUPPORT PACKAGE
# O8 l+ W4 U0 t8 E- D9 { - 18 *
q0 ~3 y# f4 z! ^6 d% n9 Z - 19 * ST Microelectronics STM32
: R9 F2 [ a) B: U0 n& W - 20 * with the% l+ [" s# K0 T+ M( d; r
- 21 * STM3210B-EVAL Evaluation Board
% z9 L8 n! w! m! f" w, M5 m- o - 22 *
( h; d Z; i, e5 Z* i - 23 * Filename : bsp.h+ P5 F! x$ u! {5 N
- 24 * Version : V1.00/ T$ S( b% J7 B8 g9 L7 t
- 25 * Programmer(s) : Brian Nagel
$ D. t j, u) c4 U$ g' w - 26 *********************************************************************************************************
0 w1 Q; l- U( j3 [. o& j9 X - 27 */, C" w7 [, ~) E2 C! l8 ]
- 28 $ y$ g. c9 w7 v
- 29 #ifndef __DSP_ASM_H__8 N" D& s$ W* ?: j6 R2 P& Z
- 30 #define __DSP_ASM_H__0 h4 ]- U# j2 H3 X8 D4 P, ^, B" G
- 31 6 D8 S: w: L9 I) u0 Z4 Q
- 32 /*: ]9 r* g8 D6 n/ E
- 33 *********************************************************************************************************
, N6 |) h+ N4 N - 34 * EXTERNS8 c2 I. I" t( J) C
- 35 *********************************************************************************************************0 X) c+ n- A; }& C* L" e
- 36 */2 e5 k: V/ U6 k: i6 Q& P* e- Z. G7 {
- 37
" ?$ e9 {) [' R# x - 38 #ifdef DSP_ASM
' c3 w. J9 ^$ a# r - 39 #define DSP_EXT
, O* \( M. a8 \6 t7 t - 40 #else
2 x! [4 X8 P& t5 f" z) C5 m R2 ]2 z - 41 #define DSP_EXT extern, S# r5 {+ ]# q+ r
- 42 #endif
3 v. V9 Q N# R: B( _ ~ - 43 2 \" C P9 z* W
- 44 /*3 O m1 q; i' l
- 45 *********************************************************************************************************: [3 q9 g ~: l4 K! m r0 T
- 46 * INCLUDE FILES
# I) Z# ^8 _+ _! |; l - 47 *********************************************************************************************************1 b3 i2 B# g3 p! Y& u0 Q
- 48 */, N* z) J1 U- C% k# f" c( G
- 49
# M% S' h5 m+ [0 D3 r% ~ - 50 ( s, |9 h' k$ c6 S" H. N) i
- 51
" I/ R9 k( Q9 V6 X4 [1 H - 52 ; @3 _/ e. n; m1 `+ G B/ I
- 53 /*" E/ w9 d( C' h4 c! F/ L
- 54 *********************************************************************************************************
/ D+ k. F0 m. T# d - 55 * GLOBAL VARIABLES+ m; S- m P& F X$ Q
- 56 *********************************************************************************************************
% \3 ^ s+ z0 q3 h' [+ p4 D - 57 */
# p ^* S. d, B7 f - 58 - w8 q. K0 o9 q4 i+ @( G
- 59 ; {. `1 t( w- h2 N
- 60 /*
# G, U+ s; \) o$ C+ w - 61 *********************************************************************************************************5 C, a6 u" ?& V
- 62 * MACRO'S
1 v Q7 r- m- f1 U" e: n y - 63 *********************************************************************************************************
8 \! r( `8 _/ l, e' i) n! U9 _ - 64 */% T6 T% r& V) F/ X$ n$ N* e
- 65 v/ @5 G* R. w: ?: b* y
- 66 ' H6 H# O5 \5 R9 A7 R2 i
- 67 /*
4 R3 e& q2 a4 \1 S9 o6 {1 S - 68 *********************************************************************************************************
, {8 E+ ^: O, e6 Z! m' [! O# J9 v6 W - 69 * FUNCTION PROTOTYPES* {" v9 W9 t+ Y' k* v
- 70 *********************************************************************************************************2 v* b: @1 Y4 R( f" q Q( b; V
- 71 */
/ k1 K- `! i1 ^# ` - 72
+ q! P# a2 Z4 i, A0 w7 D - 73 void dsp_asm_test(void);
" `+ f' j" q* S' b - 74 void dsp_asm_init(void);+ M. ^( }( i s1 T" t0 J$ _
- 75
1 |/ }* I3 W/ `* D8 ^0 @' Q/ R - 76 #endif /* End of module include. */
复制代码
! y# i, ?4 Q* q( s 着重分析下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位数据。下面的两句0 q% A; i7 s7 ^
float X = NPT * ((float)lX) /32768;
0 r: Z/ r5 ` G: V. A h4 L% R4 c float Y = NPT * ((float)lY) /32768
8 ?* H$ X$ `8 }2 u 目的就是把数据浮点化,至于为什么是除以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次方。然后才能进行其他的运算。
$ b" U+ P# {2 ^0 U 这里是ST公司采用了DSP专用芯片(主要是指TI)的写法,也就是说尽管DSP的芯片类型很多,数据变量的定义也各有差异,但原理是一样的,最终还是要采用DSP习惯的运算方式。至于为什么一定要采用浮点运算,因为机器是傻子,然而TI公司的工程师是天才。 main函数中我们只需在while(1)前加上dsp_asm_init(); dsp_asm_test();即可。3 L" T/ _0 m/ r% Y/ {
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,测量最大有效频率3200Hz8 j: t9 X. e! U5 S: }
256点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谐波幅值
+ l4 q+ s: X, I) c3 Q3 w' _ 总结:该工程中模拟信号源为: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。
3 V B+ a0 q! s/ o- A! a |