Fht for two microphone real time

Projects Programming
3

no fht library


#define LIN_OUT 1 // use the log output function
#define FHT_N 64 // set to 256 point fht
#define cbi(sfr, bit) (_SFR_BYTE(sfr) &= ~_BV(bit))
#define sbi(sfr, bit) (_SFR_BYTE(sfr) |= _BV(bit))
#include <FHT.h> 

int f;
int Rreal[FHT_N];
int Lreal[FHT_N];
int RMAG[FHT_N];
int LMAG[FHT_N];



void setup() {
  ADCSRB = 0;
  sbi(ADCSRA, ADEN); // Enable ADC
  sbi(ADCSRA, ADATE); // Auto trigger
  sbi(ADCSRA, ADSC); // Start conversion
  // 19.231 kHz
  sbi(ADCSRA, ADPS2);
  sbi(ADCSRA, ADPS1);
  cbi(ADCSRA, ADPS0); 
Serial.begin(115200); // use the serial port
}

void loop() {
cli();  // UDRE interrupt slows this way down on arduino1.0   
for (int i = 0 ; i < FHT_N ; i++) { // save 256 samples
while (!(ADCSRA & _BV(ADIF))); // wait for adc to be ready
ADMUX = (DEFAULT << 6) |0; // A0
sbi(ADCSRA, ADIF); // Clear interrupt flag
byte m0 = ADCL; // fetch adc data
byte j0 = ADCH;
int k0= (j0 << 8) | m0; // form into an int
k0 -= 0x0200; // form into a signed int
k0 <<= 6; // form into a 16b signed int
Rreal[i] = k0; // put real data into bins

while (!(ADCSRA & _BV(ADIF))); // wait for adc to be ready
ADMUX = (DEFAULT << 6) |2; // A2
sbi(ADCSRA, ADIF); // Clear interrupt flag
byte m2 = ADCL; // fetch adc data
byte j2 = ADCH;
int k2= (j2 << 8) | m2; // form into an int
k2 -= 0x0200; // form into a signed int
k2 <<= 6; // form into a 16b signed int
Lreal[i] = k2; // put real data into bins

}
for (int i = 0 ; i < FHT_N ; i++) {
fht_input[i]=Rreal[i];
delay(1);
}
fht_window(); // window the data for better frequency response
fht_reorder(); // reorder the data before doing the fht
fht_run(); // process the data in the fht
fht_mag_lin(); // take the output of the fht


for (uint8_t i = 2 ; i < FHT_N / 2 ; i++) {
RMAG[i]=fht_lin_out[i];
} 


for (int i = 0 ; i < FHT_N ; i++) {
fht_input[i]=Lreal[i];
delay(1);
}
fht_window(); // window the data for better frequency response
fht_reorder(); // reorder the data before doing the fht
fht_run(); // process the data in the fht
fht_mag_lin(); // take the output of the fht
sei();

for (uint8_t i = 2 ; i < FHT_N / 2 ; i++) {
LMAG[i]=fht_lin_out[i];
} 


for (uint8_t i = 2 ; i < FHT_N / 2 ; i++) {
f=i * 9600UL / FHT_N;
Serial.print(f);
Serial.print(":");
Serial.print(RMAG[i]);
Serial.print(":");
Serial.println(LMAG[i]);
} 
delay(1000);
}