Betrouwbare frequentie detectie met DSP technieken (5 / 7 stap)

Stap 5: Hier is alle Code

 #include "C4.h"// Sample Frequency in Hzconstfloat sample_freq = 22050; int len = sizeof(rawData); int i,k; long sum, sum_old; int thresh = 0; float freq_per = 0; byte pd_state = 0; voidsetup() { Serial.begin(115200); sum = 0; pd_state = 0; int period = 0; // Autocorrelation for(i=0; i < len; i++) { sum_old = sum; sum = 0; for(k=0; k < len-i; k++) sum += (rawData[k]-128)*(rawData[k+i]-128)/256; // Peak Detect State Machine if (pd_state == 2 && (sum-sum_old) <=0) { period = i; pd_state = 3; } if (pd_state == 1 && (sum > thresh) && (sum-sum_old) > 0) pd_state = 2; if (!i) { thresh = sum * 0.5; pd_state = 1; } } // Frequency identified in Hz freq_per = sample_freq/period; Serial.println(freq_per); } voidloop() { // put your main code here, to run repeatedly: }