Marcelo Rebonatto / Mbed 2 deprecated PMED_Tempo

Versão do protegemed que calcula o tempo em ms da fuga, calcula o numero de onverflow (valores muito baixo) e underflow (valores muito altos). Além disso, calcula um valor médio a partir dos valores capturados e não apenas pela fft.

Dependencies:   EthernetInterface mbed-rtos mbed

Codes/SignalProcessor.cpp@1:917ca6b5d9d9, 2014-07-18 (annotated)

Committer:
rebonatto
Date:
Fri Jul 18 20:24:45 2014 +0000
Revision:
1:917ca6b5d9d9
Parent:
0:c64e1194230b
Child:
2:86c3cb25577b
Nova vers?o: problemas com excesso de mem?ria.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
rebonatto 0:c64e1194230b 1 /*
rebonatto 0:c64e1194230b 2 * SignalProcessor.cpp
rebonatto 0:c64e1194230b 3 *
rebonatto 0:c64e1194230b 4 * Created on:
rebonatto 0:c64e1194230b 5 * Author:
rebonatto 0:c64e1194230b 6 */
rebonatto 0:c64e1194230b 7
rebonatto 0:c64e1194230b 8 #include <math.h>
rebonatto 0:c64e1194230b 9 #include <stdlib.h>
rebonatto 0:c64e1194230b 10 #include <stdio.h>
rebonatto 0:c64e1194230b 11 #include <string.h>
rebonatto 0:c64e1194230b 12
rebonatto 0:c64e1194230b 13 #include "SignalProcessor.h"
rebonatto 0:c64e1194230b 14
rebonatto 0:c64e1194230b 15 #define SWAP(a,b) tempr=(a);(a)=(b);(b)=tempr
rebonatto 0:c64e1194230b 16 #define PI 3.14159265358979323846F
rebonatto 0:c64e1194230b 17 // 3.141597653564793332212487132
rebonatto 0:c64e1194230b 18 // 3.14159265358979323846
rebonatto 0:c64e1194230b 19
rebonatto 0:c64e1194230b 20
rebonatto 0:c64e1194230b 21 /* Elementos vm2, under, over adicionados em 20/05/2014 por Rebonatto */
rebonatto 0:c64e1194230b 22 /* vm2 eh o calculo do valor medio, under eh a cotagem dos valores do AD com 0 */
rebonatto 0:c64e1194230b 23 /* over e a contagem do AD com 4095 */
rebonatto 0:c64e1194230b 24 /* over e under sao para verificar se o processo de ajuste dos dados esta Ok e vm2 para conferir o vm da fft */
rebonatto 0:c64e1194230b 25 void SignalProcessor::CalculateRMSBulk(float *result, float *vm2, int *under, int *over)
rebonatto 0:c64e1194230b 26 {
rebonatto 0:c64e1194230b 27 int nChannel,nSample;
rebonatto 0:c64e1194230b 28
rebonatto 0:c64e1194230b 29 for(nChannel=0;nChannel<Settings::get_MaxChannels();nChannel++)
rebonatto 0:c64e1194230b 30 result[nChannel] = vm2[nChannel] = under[nChannel] = over[nChannel] = 0;
rebonatto 0:c64e1194230b 31
rebonatto 0:c64e1194230b 32 for(nChannel=0;nChannel<Settings::get_MaxChannels();nChannel++)
rebonatto 0:c64e1194230b 33 {
rebonatto 0:c64e1194230b 34 for(nSample=0;nSample<Settings::get_Samples();nSample++)
rebonatto 0:c64e1194230b 35 {
rebonatto 0:c64e1194230b 36 unsigned short int v = Capture::GetValue(nSample, nChannel);
rebonatto 0:c64e1194230b 37 /* novos calculos */
rebonatto 0:c64e1194230b 38 vm2[nChannel] += v;
rebonatto 0:c64e1194230b 39 if (v <= 20)
rebonatto 0:c64e1194230b 40 under[nChannel] = under[nChannel] + 1;
rebonatto 0:c64e1194230b 41 if (v >= 4075)
rebonatto 0:c64e1194230b 42 over[nChannel] = over[nChannel] + 1;
rebonatto 0:c64e1194230b 43 float val = (float)v;
rebonatto 0:c64e1194230b 44
rebonatto 0:c64e1194230b 45 val -= Settings::get_Offset(nChannel);
rebonatto 0:c64e1194230b 46 val /= Settings::get_Gain(nChannel);
rebonatto 0:c64e1194230b 47 val *= val;
rebonatto 0:c64e1194230b 48 result[nChannel] += val;
rebonatto 0:c64e1194230b 49 }
rebonatto 0:c64e1194230b 50 result[nChannel] /= (float)Settings::get_Samples();
rebonatto 0:c64e1194230b 51 result[nChannel] = sqrt(result[nChannel]);
rebonatto 0:c64e1194230b 52
rebonatto 0:c64e1194230b 53 /* novos calculos */
rebonatto 0:c64e1194230b 54 vm2[nChannel] /= (float)Settings::get_Samples();
rebonatto 0:c64e1194230b 55 }
rebonatto 0:c64e1194230b 56 }
rebonatto 0:c64e1194230b 57
rebonatto 0:c64e1194230b 58 float SignalProcessor::CalculateRMS(unsigned short int *buffer,int nChannel)
rebonatto 0:c64e1194230b 59 {
rebonatto 0:c64e1194230b 60 float result=0;
rebonatto 0:c64e1194230b 61 int nSample;
rebonatto 0:c64e1194230b 62
rebonatto 0:c64e1194230b 63 for(nSample=0;nSample<Settings::get_Samples();nSample++)
rebonatto 0:c64e1194230b 64 {
rebonatto 0:c64e1194230b 65
rebonatto 0:c64e1194230b 66 unsigned short int v = buffer[nSample];
rebonatto 0:c64e1194230b 67 float val = (float)v;
rebonatto 0:c64e1194230b 68 // cada ponto
rebonatto 0:c64e1194230b 69 val -= Settings::get_Offset(nChannel); // diminui o offset
rebonatto 0:c64e1194230b 70 val /= Settings::get_Gain(nChannel); // divide pelo ganhp
rebonatto 0:c64e1194230b 71 val *= val; // eleva ao quadrado
rebonatto 0:c64e1194230b 72 result += val; // soma
rebonatto 0:c64e1194230b 73 }
rebonatto 0:c64e1194230b 74 result /= (float)Settings::get_Samples(); // divide pelo numero de amostras (256)
rebonatto 0:c64e1194230b 75 result = sqrt(result);
rebonatto 0:c64e1194230b 76 return result;
rebonatto 0:c64e1194230b 77 }
rebonatto 0:c64e1194230b 78
rebonatto 0:c64e1194230b 79 void SignalProcessor::CalculateFFT(unsigned short int *buffer,float *sen,float *cos,float *vm,int sign, int ch)
rebonatto 0:c64e1194230b 80 {
rebonatto 0:c64e1194230b 81 int i;
rebonatto 0:c64e1194230b 82 //float value[256];
rebonatto 0:c64e1194230b 83 /*
rebonatto 0:c64e1194230b 84 printf("Tamanho float %lu\n", sizeof(float));
rebonatto 0:c64e1194230b 85 printf("Tamanho double %lu\n", sizeof(double));
rebonatto 0:c64e1194230b 86 printf("Tamanho unsigned short int %lu\n", sizeof(unsigned short int));
rebonatto 0:c64e1194230b 87 printf("Tamanho unsigned long %lu\n", sizeof(unsigned long));
rebonatto 0:c64e1194230b 88 printf("Tamanho unsigned long long %lu\n", sizeof(unsigned long long));
rebonatto 0:c64e1194230b 89 */
rebonatto 0:c64e1194230b 90
rebonatto 0:c64e1194230b 91 /*
rebonatto 0:c64e1194230b 92 for(int i=0; i < Settings::get_Samples(); i++)
rebonatto 0:c64e1194230b 93 printf("%d*",buffer[i]);
rebonatto 0:c64e1194230b 94 printf("\n");
rebonatto 0:c64e1194230b 95 */
rebonatto 0:c64e1194230b 96
rebonatto 0:c64e1194230b 97 //printf("[0] %d %d %d %d\n", buffer[0], buffer[100], buffer[200], buffer[255]);
rebonatto 0:c64e1194230b 98 /*
rebonatto 0:c64e1194230b 99 for(i=0; i<Settings::get_Samples();i++)
rebonatto 0:c64e1194230b 100 value[i]= (float) ( (buffer[i] - Settings::get_Offset(ch)) / Settings::get_Gain(ch) );
rebonatto 0:c64e1194230b 101 */
rebonatto 1:917ca6b5d9d9 102 printf("Antes ComplexFFT\n");
rebonatto 0:c64e1194230b 103 float* fft = ComplexFFT(buffer,1, ch); //deve desalocar memoria do ptr retornado
rebonatto 1:917ca6b5d9d9 104 printf("Passou ComplexFFT\n");
rebonatto 0:c64e1194230b 105
rebonatto 0:c64e1194230b 106 /*
rebonatto 0:c64e1194230b 107 Mapa do vetor fft.
rebonatto 0:c64e1194230b 108 O vetor tem 2 vezes o no. de amostras. Cada par de valores (portanto n e n+1), representam, respectivamente
rebonatto 0:c64e1194230b 109 COS e SEN.
rebonatto 0:c64e1194230b 110 Os dois primeiros valores reprensetam a frequencia 0Hz, portanto sao atribuidas ao valor medio.
rebonatto 0:c64e1194230b 111 Os demais pares de valores representam a fundamental e suas harmonicas,
rebonatto 0:c64e1194230b 112 sendo que se a fundamental for 60Hz, teremos: 60,120,180,240...
rebonatto 0:c64e1194230b 113 Para a nossa aplicacao apenas as 12 primeiras harmonicas serao utilizadas (720Hz)
rebonatto 0:c64e1194230b 114 */
rebonatto 0:c64e1194230b 115
rebonatto 0:c64e1194230b 116 //*vm = DFT(value, sen, cos);
rebonatto 0:c64e1194230b 117 *vm = fft[0];
rebonatto 0:c64e1194230b 118
rebonatto 0:c64e1194230b 119 for(int i=1;i<Settings::get_MaxHarmonics()+1;i++)
rebonatto 0:c64e1194230b 120 {
rebonatto 0:c64e1194230b 121 cos[i-1] = fft[i*2];
rebonatto 0:c64e1194230b 122 sen[i-1] = fft[i*2+1];
rebonatto 0:c64e1194230b 123 }
rebonatto 0:c64e1194230b 124
rebonatto 0:c64e1194230b 125 for(int i=0;i<Settings::get_MaxHarmonics();i++)
rebonatto 0:c64e1194230b 126 {
rebonatto 0:c64e1194230b 127 printf("[%dHz]\tsen %.4f\tcos %.4f\n", (i+1)*60, sen[i], cos[i]);
rebonatto 0:c64e1194230b 128 }
rebonatto 0:c64e1194230b 129
rebonatto 0:c64e1194230b 130 free(fft);
rebonatto 0:c64e1194230b 131 //printf("[3] %d %d %d %d\n", buffer[0], buffer[100], buffer[200], buffer[255]);
rebonatto 0:c64e1194230b 132 }
rebonatto 0:c64e1194230b 133
rebonatto 0:c64e1194230b 134
rebonatto 0:c64e1194230b 135 float* SignalProcessor::ComplexFFT(unsigned short int* data, int sign, int ch)
rebonatto 0:c64e1194230b 136 {
rebonatto 0:c64e1194230b 137
rebonatto 0:c64e1194230b 138 //variables for the fft
rebonatto 0:c64e1194230b 139 unsigned long n,mmax,m,j,istep,i;
rebonatto 0:c64e1194230b 140 //double wtemp,wr,wpr,wpi,wi,theta,tempr,tempi;
rebonatto 0:c64e1194230b 141 float wtemp,wr,wpr,wpi,wi,theta,tempr,tempi;
rebonatto 0:c64e1194230b 142 float *vector;
rebonatto 0:c64e1194230b 143 //the complex array is real+complex so the array
rebonatto 0:c64e1194230b 144 //as a size n = 2* number of complex samples
rebonatto 0:c64e1194230b 145 //real part is the data[index] and
rebonatto 0:c64e1194230b 146 //the complex part is the data[index+1]
rebonatto 0:c64e1194230b 147
rebonatto 0:c64e1194230b 148 //new complex array of size n=2*sample_rate
rebonatto 0:c64e1194230b 149 //if(vector==0)
rebonatto 0:c64e1194230b 150 //vector=(float*)malloc(2*SAMPLE_RATE*sizeof(float)); era assim, define estava em Capture.h
rebonatto 1:917ca6b5d9d9 151
rebonatto 1:917ca6b5d9d9 152 printf("Antes malloc\n");
rebonatto 0:c64e1194230b 153 vector=(float*)malloc(2*Settings::get_Samples()*sizeof(float));
rebonatto 0:c64e1194230b 154 memset(vector,0,2*Settings::get_Samples()*sizeof(float));
rebonatto 1:917ca6b5d9d9 155 printf("DEpois malloc\n");
rebonatto 0:c64e1194230b 156 //put the real array in a complex array
rebonatto 0:c64e1194230b 157 //the complex part is filled with 0's
rebonatto 0:c64e1194230b 158 //the remaining vector with no data is filled with 0's
rebonatto 0:c64e1194230b 159 //for(n=0; n<SAMPLE_RATE;n++)era assim, define estava em Capture.h
rebonatto 0:c64e1194230b 160
rebonatto 0:c64e1194230b 161 for(n=0; n<Settings::get_Samples();n++)
rebonatto 0:c64e1194230b 162 {
rebonatto 0:c64e1194230b 163 if(n<Settings::get_Samples()){
rebonatto 0:c64e1194230b 164 //vector[2*n]= (float) ( (data[n] - Settings::get_Offset(ch)) / Settings::get_Gain(ch) );
rebonatto 0:c64e1194230b 165 vector[2*n]= (float) data[n] ;
rebonatto 0:c64e1194230b 166 // printf("%.4f$", vector[2*n]);
rebonatto 0:c64e1194230b 167 }
rebonatto 0:c64e1194230b 168 else
rebonatto 0:c64e1194230b 169 vector[2*n]=0;
rebonatto 0:c64e1194230b 170 vector[2*n+1]=0;
rebonatto 0:c64e1194230b 171 }
rebonatto 0:c64e1194230b 172
rebonatto 0:c64e1194230b 173 //printf("\n");
rebonatto 0:c64e1194230b 174
rebonatto 0:c64e1194230b 175 //printf("[1] %d %d %d %d\n", data[0], data[100], data[200], data[255]);
rebonatto 0:c64e1194230b 176
rebonatto 0:c64e1194230b 177 //binary inversion (note that the indexes
rebonatto 0:c64e1194230b 178 //start from 0 witch means that the
rebonatto 0:c64e1194230b 179 //real part of the complex is on the even-indexes
rebonatto 0:c64e1194230b 180 //and the complex part is on the odd-indexes)
rebonatto 0:c64e1194230b 181 //n=SAMPLE_RATE << 1; //multiply by 2era assim, define estava em Capture.h
rebonatto 0:c64e1194230b 182 n=Settings::get_Samples() << 1; //multiply by 2
rebonatto 0:c64e1194230b 183 j=0;
rebonatto 0:c64e1194230b 184 for (i=0;i<n/2;i+=2) {
rebonatto 0:c64e1194230b 185 if (j > i) {
rebonatto 0:c64e1194230b 186 SWAP(vector[j],vector[i]);
rebonatto 0:c64e1194230b 187 SWAP(vector[j+1],vector[i+1]);
rebonatto 0:c64e1194230b 188 if((j/2)<(n/4)){
rebonatto 0:c64e1194230b 189 SWAP(vector[(n-(i+2))],vector[(n-(j+2))]);
rebonatto 0:c64e1194230b 190 SWAP(vector[(n-(i+2))+1],vector[(n-(j+2))+1]);
rebonatto 0:c64e1194230b 191 }
rebonatto 0:c64e1194230b 192 }
rebonatto 0:c64e1194230b 193 m=n >> 1;
rebonatto 0:c64e1194230b 194 while (m >= 2 && j >= m) {
rebonatto 0:c64e1194230b 195 j -= m;
rebonatto 0:c64e1194230b 196 m >>= 1;
rebonatto 0:c64e1194230b 197 }
rebonatto 0:c64e1194230b 198 j += m;
rebonatto 0:c64e1194230b 199 }
rebonatto 0:c64e1194230b 200 //end of the bit-reversed order algorithm
rebonatto 0:c64e1194230b 201
rebonatto 0:c64e1194230b 202 //Danielson-Lanzcos routine
rebonatto 0:c64e1194230b 203 mmax=2;
rebonatto 0:c64e1194230b 204 while (n > mmax) {
rebonatto 0:c64e1194230b 205 istep=mmax << 1;
rebonatto 0:c64e1194230b 206 theta=sign*(2*PI/mmax);
rebonatto 0:c64e1194230b 207 wtemp=sin(0.5*theta);
rebonatto 0:c64e1194230b 208 wpr = -2.0*wtemp*wtemp;
rebonatto 0:c64e1194230b 209 wpi=sin(theta);
rebonatto 0:c64e1194230b 210 wr=1.0;
rebonatto 0:c64e1194230b 211 wi=0.0;
rebonatto 0:c64e1194230b 212 for (m=1;m<mmax;m+=2) {
rebonatto 0:c64e1194230b 213 for (i=m;i<=n;i+=istep) {
rebonatto 0:c64e1194230b 214 j=i+mmax;
rebonatto 0:c64e1194230b 215 tempr=wr*vector[j-1]-wi*vector[j];
rebonatto 0:c64e1194230b 216 tempi=wr*vector[j]+wi*vector[j-1];
rebonatto 0:c64e1194230b 217 vector[j-1]=vector[i-1]-tempr;
rebonatto 0:c64e1194230b 218 vector[j]=vector[i]-tempi;
rebonatto 0:c64e1194230b 219 vector[i-1] += tempr;
rebonatto 0:c64e1194230b 220 vector[i] += tempi;
rebonatto 0:c64e1194230b 221 }
rebonatto 0:c64e1194230b 222 wr=(wtemp=wr)*wpr-wi*wpi+wr;
rebonatto 0:c64e1194230b 223 wi=wi*wpr+wtemp*wpi+wi;
rebonatto 0:c64e1194230b 224 }
rebonatto 0:c64e1194230b 225 mmax=istep;
rebonatto 0:c64e1194230b 226 }
rebonatto 0:c64e1194230b 227 //end of the algorithm
rebonatto 0:c64e1194230b 228
rebonatto 0:c64e1194230b 229 /*
rebonatto 0:c64e1194230b 230 // Ajustes a FFT
rebonatto 0:c64e1194230b 231 for(i = 0; i < Settings::get_Samples()*2; i++ ){
rebonatto 0:c64e1194230b 232 vector[i] = (float) ((2 * vector[i]) / Settings::get_Samples() );
rebonatto 0:c64e1194230b 233 /*
rebonatto 0:c64e1194230b 234 if (i % 2 == 1)
rebonatto 0:c64e1194230b 235 vector[i] = vector[i] * -1;
rebonatto 0:c64e1194230b 236
rebonatto 0:c64e1194230b 237 }
rebonatto 0:c64e1194230b 238 */
rebonatto 0:c64e1194230b 239 //printf("[2] %d %d %d %d\n", data[0], data[100], data[200], data[255]);
rebonatto 0:c64e1194230b 240
rebonatto 0:c64e1194230b 241 return vector;
rebonatto 0:c64e1194230b 242 }
rebonatto 0:c64e1194230b 243
rebonatto 0:c64e1194230b 244 /*
rebonatto 0:c64e1194230b 245 float SignalProcessor::DFT(float *data, float *seno, float *coss){
rebonatto 0:c64e1194230b 246 int i, j;
rebonatto 0:c64e1194230b 247
rebonatto 0:c64e1194230b 248 for(i=0; i < Settings::get_MaxHarmonics()+1; i++)
rebonatto 0:c64e1194230b 249 seno[i] = coss[i] = 0;
rebonatto 0:c64e1194230b 250
rebonatto 0:c64e1194230b 251 for(i=0; i < Settings::get_Samples(); i++){
rebonatto 0:c64e1194230b 252 for(j = 0; j < Settings::get_MaxHarmonics()+1; j++ ){
rebonatto 0:c64e1194230b 253 coss[j] += (data[i] * (cos( (2 * PI * i * j) / Settings::get_Samples() ) ) ) ;
rebonatto 0:c64e1194230b 254 seno[j] += (data[i] * (sin( (2 * PI * i * j) / Settings::get_Samples() ) ) ) ;
rebonatto 0:c64e1194230b 255 }
rebonatto 0:c64e1194230b 256 }
rebonatto 0:c64e1194230b 257
rebonatto 0:c64e1194230b 258 for(j = 1; j < Settings::get_MaxHarmonics()+1; j++ ){
rebonatto 0:c64e1194230b 259 coss[j] = 2 * coss[j] / Settings::get_Samples();
rebonatto 0:c64e1194230b 260 seno[j] = 2 * seno[j] / Settings::get_Samples() ;
rebonatto 0:c64e1194230b 261 }
rebonatto 0:c64e1194230b 262 return (float) (coss[0] / Settings::get_Samples()) + (seno[0] / Settings::get_Samples());
rebonatto 0:c64e1194230b 263 }
rebonatto 0:c64e1194230b 264 */