-
Notifications
You must be signed in to change notification settings - Fork 0
/
Vumeter.cpp
127 lines (106 loc) · 4.41 KB
/
Vumeter.cpp
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
#include "Vumeter.h"
#include "config.h"
#include "CastaWatchCommon.h"
#include <driver/i2s.h>
uint8_t buffer[BUFFER_SIZE] = {0};
#include <arduinoFFT.h>
// TWATCH 2020 V3 PDM microphone pin
#define MIC_DATA 2
#define MIC_CLOCK 0
static lv_obj_t * myScreen;
#define SAMPLES 1024 // Must be a power of 2
#define SAMPLING_FREQ 44100 // Hz, must be 40000 or less due to ADC conversion time. Determines maximum frequency that can be analysed by the FFT Fmax=sampleF/2.
//#define AMPLITUDE 1000 // Depending on your audio source level, you may need to alter this value. Can be used as a 'sensitivity' control.
#define NUM_BANDS 16
int oldBarHeights[] = {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
int bandValues[] = {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
double vReal[SAMPLES];
double vImag[SAMPLES];
unsigned long newTime;arduinoFFT FFT = arduinoFFT(vReal, vImag, SAMPLES, SAMPLING_FREQ);
static void close(){
lv_scr_load(mainScreen);
lv_obj_del(myScreen);
InitializeSpeaker();
}
static void event_close(lv_event_t * e)
{
lv_dir_t gesture = lv_indev_get_gesture_dir(lv_indev_get_act());
if (gesture == LV_DIR_RIGHT){
close();
}
}
uint32_t color[16] = {0};
void LaunchVumeter(){
myScreen = lv_obj_create(NULL);
lv_obj_set_size(myScreen, 240, 240);
lv_obj_add_flag(myScreen, LV_OBJ_FLAG_CLICKABLE);
lv_scr_load(myScreen);
lv_obj_add_event_cb(myScreen,event_close, LV_EVENT_GESTURE, NULL );
color[0] = ttgo->tft->color565(0x9C, 0x4F, 0X96);
color[1] = ttgo->tft->color565(0xFF, 0x63, 0X55);
color[2] = ttgo->tft->color565(0xFB, 0xA9, 0X49);
color[3] = ttgo->tft->color565(0xFA, 0xE4, 0X42);
color[4] = ttgo->tft->color565(0x8B, 0xD4, 0X48);
color[5] = ttgo->tft->color565(0x2A, 0xA8, 0XF2);
color[6] = ttgo->tft->color565(0x9C, 0x4F, 0X96);
color[7] = ttgo->tft->color565(0xFF, 0x63, 0X55);
color[8] = ttgo->tft->color565(0xFB, 0xA9, 0X49);
color[9] = ttgo->tft->color565(0xFA, 0xE4, 0X42);
color[10] = ttgo->tft->color565(0x8B, 0xD4, 0X48);
color[11] = ttgo->tft->color565(0x2A, 0xA8, 0XF2);
color[12] = ttgo->tft->color565(0x9C, 0x4F, 0X96);
color[13] = ttgo->tft->color565(0xFF, 0x63, 0X55);
color[14] = ttgo->tft->color565(0xFB, 0xA9, 0X49);
color[15] = ttgo->tft->color565(0xFA, 0xE4, 0X42);
InitializeMic();
}
uint8_t val1, val2;
int16_t val16 = 0;
void UpdateVumeter(){
for (int i = 0; i<NUM_BANDS; i++){
bandValues[i] = 0;
}
size_t read_len = 0;
i2s_read(I2S_NUM_0, (char *) buffer, BUFFER_SIZE, &read_len, portMAX_DELAY);
for(int i=0;i < BUFFER_SIZE/2;i++){
val1 = buffer[i * 2];
val2 = buffer[i * 2 + 1] ;
val16 = val1 + val2 * 256;
vReal[i] = ((float)val16/1000.0f);
vImag[i] = 0;
}
FFT.DCRemoval();
FFT.Windowing(FFT_WIN_TYP_HAMMING, FFT_FORWARD);
FFT.Compute(FFT_FORWARD);
FFT.ComplexToMagnitude();
for(int i=2;i<(SAMPLES/2);i++){
if (vReal[i]>1){
if (i<=2 ) bandValues[0] += (int)vReal[i];
if (i>2 && i<=3 ) bandValues[1] += (int)vReal[i];
if (i>3 && i<=5 ) bandValues[2] += (int)vReal[i];
if (i>5 && i<=7 ) bandValues[3] += (int)vReal[i];
if (i>7 && i<=9 ) bandValues[4] += (int)vReal[i];
if (i>9 && i<=13 ) bandValues[5] += (int)vReal[i];
if (i>13 && i<=18 ) bandValues[6] += (int)vReal[i];
if (i>18 && i<=25 ) bandValues[7] += (int)vReal[i];
if (i>25 && i<=36 ) bandValues[8] += (int)vReal[i];
if (i>36 && i<=50 ) bandValues[9] += (int)vReal[i];
if (i>50 && i<=69 ) bandValues[10] += (int)vReal[i];
if (i>69 && i<=97 ) bandValues[11] += (int)vReal[i];
if (i>97 && i<=135) bandValues[12] += (int)vReal[i];
if (i>135 && i<=189) bandValues[13] += (int)vReal[i];
if (i>189 && i<=264) bandValues[14] += (int)vReal[i];
if (i>264 ) bandValues[15] += (int)vReal[i];
}
}
for(int i=0;i<16;i++){
int pos = i * 15;
for (int y=0;y<16;y++){
if (bandValues[i]/15>y ){
ttgo->tft->fillRect(pos,240 -15- y*15, 14,14, color[i]);
} else {
ttgo->tft->fillRect(pos, 240 -15- y*15, 14,14,ttgo->tft->color565(0x00, 0x00, 0X00));
}
}
}
}