No photo version of "F746_SpectralAnalysis_Example".

Dependencies:   BSP_DISCO_F746NG BUTTON_GROUP LCD_DISCO_F746NG TS_DISCO_F746NG UIT_FFT_Real mbed

Committer:
MikamiUitOpen
Date:
Tue Nov 24 12:34:55 2015 +0000
Revision:
0:9d7f931c704a
1

Who changed what in which revision?

UserRevisionLine numberNew 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