No photo version of "F746_SpectralAnalysis_Example".
Dependencies: BSP_DISCO_F746NG BUTTON_GROUP LCD_DISCO_F746NG TS_DISCO_F746NG UIT_FFT_Real mbed
SpactrumAnalysisClasses/SpectrumDisplay.cpp@0:9d7f931c704a, 2015-11-24 (annotated)
- Committer:
- MikamiUitOpen
- Date:
- Tue Nov 24 12:34:55 2015 +0000
- Revision:
- 0:9d7f931c704a
1
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
MikamiUitOpen | 0:9d7f931c704a | 1 | //------------------------------------------------------- |
MikamiUitOpen | 0:9d7f931c704a | 2 | // Class for display spectrum |
MikamiUitOpen | 0:9d7f931c704a | 3 | // Copyright (c) 2015 MIKAMI, Naoki, 2015/10/27 |
MikamiUitOpen | 0:9d7f931c704a | 4 | //------------------------------------------------------- |
MikamiUitOpen | 0:9d7f931c704a | 5 | |
MikamiUitOpen | 0:9d7f931c704a | 6 | #include "SpectrumDisplay.hpp" |
MikamiUitOpen | 0:9d7f931c704a | 7 | |
MikamiUitOpen | 0:9d7f931c704a | 8 | namespace Mikami |
MikamiUitOpen | 0:9d7f931c704a | 9 | { |
MikamiUitOpen | 0:9d7f931c704a | 10 | SpectrumDisplay::SpectrumDisplay( |
MikamiUitOpen | 0:9d7f931c704a | 11 | LCD_DISCO_F746NG &lcd, |
MikamiUitOpen | 0:9d7f931c704a | 12 | int nFft, int x0, int y0, |
MikamiUitOpen | 0:9d7f931c704a | 13 | float db1, int bin, float maxDb, int fs) |
MikamiUitOpen | 0:9d7f931c704a | 14 | : N_FFT_(nFft), X0_(x0), Y0_(y0), |
MikamiUitOpen | 0:9d7f931c704a | 15 | DB1_(db1), BIN_(bin), MAX_DB_(maxDb), FS_(fs), |
MikamiUitOpen | 0:9d7f931c704a | 16 | LCD_(&lcd) |
MikamiUitOpen | 0:9d7f931c704a | 17 | { |
MikamiUitOpen | 0:9d7f931c704a | 18 | AxisX(); |
MikamiUitOpen | 0:9d7f931c704a | 19 | AxisY(); |
MikamiUitOpen | 0:9d7f931c704a | 20 | } |
MikamiUitOpen | 0:9d7f931c704a | 21 | |
MikamiUitOpen | 0:9d7f931c704a | 22 | void SpectrumDisplay::BarChart(float db[], uint32_t backColor) |
MikamiUitOpen | 0:9d7f931c704a | 23 | { |
MikamiUitOpen | 0:9d7f931c704a | 24 | const float OFFSET = 60.0f; |
MikamiUitOpen | 0:9d7f931c704a | 25 | for (int n=1; n<=N_FFT_/2; n++) |
MikamiUitOpen | 0:9d7f931c704a | 26 | { |
MikamiUitOpen | 0:9d7f931c704a | 27 | float h = ((db[n] + OFFSET) >= 0)? db[n] + OFFSET : 0; |
MikamiUitOpen | 0:9d7f931c704a | 28 | |
MikamiUitOpen | 0:9d7f931c704a | 29 | int y = Y0_ - (int)(h*DB1_); |
MikamiUitOpen | 0:9d7f931c704a | 30 | LCD_->SetTextColor(LCD_COLOR_CYAN); |
MikamiUitOpen | 0:9d7f931c704a | 31 | LCD_->DrawLine(X0_+n, Y0_-1, X0_+n, y); |
MikamiUitOpen | 0:9d7f931c704a | 32 | LCD_->SetTextColor(backColor); |
MikamiUitOpen | 0:9d7f931c704a | 33 | LCD_->DrawLine(X0_+n, y-1, X0_+n, Y0_-(int)(MAX_DB_*DB1_)); |
MikamiUitOpen | 0:9d7f931c704a | 34 | } |
MikamiUitOpen | 0:9d7f931c704a | 35 | LCD_->SetTextColor(LCD_COLOR_YELLOW); |
MikamiUitOpen | 0:9d7f931c704a | 36 | LCD_->DrawLine(X0_, Y0_, X0_+BIN_*N_FFT_/2, Y0_); |
MikamiUitOpen | 0:9d7f931c704a | 37 | } |
MikamiUitOpen | 0:9d7f931c704a | 38 | |
MikamiUitOpen | 0:9d7f931c704a | 39 | void SpectrumDisplay::LineChart(float db[], uint32_t backColor) |
MikamiUitOpen | 0:9d7f931c704a | 40 | { |
MikamiUitOpen | 0:9d7f931c704a | 41 | const float OFFSET = 60.0f; |
MikamiUitOpen | 0:9d7f931c704a | 42 | LCD_->SetTextColor(backColor); |
MikamiUitOpen | 0:9d7f931c704a | 43 | LCD_->FillRect(X0_+1, Y0_-(int)(MAX_DB_*DB1_), |
MikamiUitOpen | 0:9d7f931c704a | 44 | N_FFT_*BIN_/2, MAX_DB_*DB1_); |
MikamiUitOpen | 0:9d7f931c704a | 45 | |
MikamiUitOpen | 0:9d7f931c704a | 46 | float h = ((db[1] + OFFSET) > 0)? db[1] + OFFSET : 0; |
MikamiUitOpen | 0:9d7f931c704a | 47 | int y1 = Y0_ - (int)(h*DB1_); |
MikamiUitOpen | 0:9d7f931c704a | 48 | for (int n=1; n<N_FFT_/2; n++) |
MikamiUitOpen | 0:9d7f931c704a | 49 | { |
MikamiUitOpen | 0:9d7f931c704a | 50 | float h2 = ((db[n+1] + OFFSET) > 0)? db[n+1] + OFFSET : 0; |
MikamiUitOpen | 0:9d7f931c704a | 51 | if (h2 > MAX_DB_) h2 = MAX_DB_; |
MikamiUitOpen | 0:9d7f931c704a | 52 | int y2 = Y0_ - (int)(h2*DB1_); |
MikamiUitOpen | 0:9d7f931c704a | 53 | LCD_->SetTextColor(LCD_COLOR_CYAN); |
MikamiUitOpen | 0:9d7f931c704a | 54 | LCD_->DrawLine(X0_+n, y1, X0_+n+1, y2); |
MikamiUitOpen | 0:9d7f931c704a | 55 | y1 = y2; |
MikamiUitOpen | 0:9d7f931c704a | 56 | } |
MikamiUitOpen | 0:9d7f931c704a | 57 | LCD_->SetTextColor(LCD_COLOR_YELLOW); |
MikamiUitOpen | 0:9d7f931c704a | 58 | LCD_->DrawLine(X0_, Y0_, X0_+BIN_*N_FFT_/2, Y0_); |
MikamiUitOpen | 0:9d7f931c704a | 59 | } |
MikamiUitOpen | 0:9d7f931c704a | 60 | |
MikamiUitOpen | 0:9d7f931c704a | 61 | // Clear Spectrum |
MikamiUitOpen | 0:9d7f931c704a | 62 | void SpectrumDisplay::Clear(uint32_t backColor) |
MikamiUitOpen | 0:9d7f931c704a | 63 | { |
MikamiUitOpen | 0:9d7f931c704a | 64 | LCD_->SetTextColor(backColor); |
MikamiUitOpen | 0:9d7f931c704a | 65 | LCD_->FillRect(X0_+1, Y0_-(int)(MAX_DB_*DB1_), |
MikamiUitOpen | 0:9d7f931c704a | 66 | N_FFT_*BIN_/2, MAX_DB_*DB1_); |
MikamiUitOpen | 0:9d7f931c704a | 67 | } |
MikamiUitOpen | 0:9d7f931c704a | 68 | |
MikamiUitOpen | 0:9d7f931c704a | 69 | // x-axis |
MikamiUitOpen | 0:9d7f931c704a | 70 | void SpectrumDisplay::AxisX() |
MikamiUitOpen | 0:9d7f931c704a | 71 | { |
MikamiUitOpen | 0:9d7f931c704a | 72 | LCD_->SetFont(&Font12); |
MikamiUitOpen | 0:9d7f931c704a | 73 | |
MikamiUitOpen | 0:9d7f931c704a | 74 | LCD_->SetTextColor(LCD_COLOR_YELLOW); |
MikamiUitOpen | 0:9d7f931c704a | 75 | LCD_->DrawLine(X0_, Y0_, X0_+BIN_*N_FFT_/2, Y0_); |
MikamiUitOpen | 0:9d7f931c704a | 76 | float dx = BIN_*(N_FFT_*1000.0f)/(float)FS_; |
MikamiUitOpen | 0:9d7f931c704a | 77 | for (int n=0; n<=(FS_/1000)/2; n++) |
MikamiUitOpen | 0:9d7f931c704a | 78 | { |
MikamiUitOpen | 0:9d7f931c704a | 79 | int xTick = X0_ + (int)(dx*n + 0.5f); |
MikamiUitOpen | 0:9d7f931c704a | 80 | char s[5]; |
MikamiUitOpen | 0:9d7f931c704a | 81 | sprintf(s, "%d", n); |
MikamiUitOpen | 0:9d7f931c704a | 82 | LCD_->DisplayStringAt(xTick-3, Y0_+10, (uint8_t *)s, LEFT_MODE); |
MikamiUitOpen | 0:9d7f931c704a | 83 | LCD_->DrawLine(xTick, Y0_, xTick, Y0_+5); |
MikamiUitOpen | 0:9d7f931c704a | 84 | } |
MikamiUitOpen | 0:9d7f931c704a | 85 | LCD_->DisplayStringAt(X0_+74, Y0_+24, (uint8_t *)"Frequency [kHz]", LEFT_MODE); |
MikamiUitOpen | 0:9d7f931c704a | 86 | } |
MikamiUitOpen | 0:9d7f931c704a | 87 | |
MikamiUitOpen | 0:9d7f931c704a | 88 | // y-axis |
MikamiUitOpen | 0:9d7f931c704a | 89 | void SpectrumDisplay::AxisY() |
MikamiUitOpen | 0:9d7f931c704a | 90 | { |
MikamiUitOpen | 0:9d7f931c704a | 91 | LCD_->SetFont(&Font12); |
MikamiUitOpen | 0:9d7f931c704a | 92 | |
MikamiUitOpen | 0:9d7f931c704a | 93 | LCD_->SetTextColor(LCD_COLOR_YELLOW); |
MikamiUitOpen | 0:9d7f931c704a | 94 | LCD_->DrawLine(X0_, Y0_+5, X0_, Y0_-(int)(MAX_DB_*DB1_)); |
MikamiUitOpen | 0:9d7f931c704a | 95 | for (int n=0; n<=(int)MAX_DB_; n+=20) |
MikamiUitOpen | 0:9d7f931c704a | 96 | { |
MikamiUitOpen | 0:9d7f931c704a | 97 | int yTick = Y0_-(int)(DB1_*n); |
MikamiUitOpen | 0:9d7f931c704a | 98 | char s[5]; |
MikamiUitOpen | 0:9d7f931c704a | 99 | sprintf(s, "%3d", n-60); |
MikamiUitOpen | 0:9d7f931c704a | 100 | LCD_->DisplayStringAt(X0_-30, yTick-5, (uint8_t *)s, LEFT_MODE); |
MikamiUitOpen | 0:9d7f931c704a | 101 | LCD_->DrawLine(X0_-5, yTick, X0_, yTick); |
MikamiUitOpen | 0:9d7f931c704a | 102 | } |
MikamiUitOpen | 0:9d7f931c704a | 103 | LCD_->DisplayStringAt(X0_-27, Y0_-(int)(DB1_*MAX_DB_)-18, (uint8_t *)"[dB]", LEFT_MODE); |
MikamiUitOpen | 0:9d7f931c704a | 104 | } |
MikamiUitOpen | 0:9d7f931c704a | 105 | } |
MikamiUitOpen | 0:9d7f931c704a | 106 |