comparison projects/measure_noisefloor/render.cpp @ 89:d41631e0fe0e

Added noise floor measurement project; also added option to run script to run without screen

+/*
+ * render.cpp
+ *
+ *  Created on: Oct 24, 2014
+ *      Author: parallels
+ */
+
+
+#include <BeagleRT.h>
+#include <Utilities.h>
+#include <cmath>
+
+int gBufferSize = 8192;
+
+// Buffers to hold samples for noise analysis
+float* gBuffers[10];
+int gBufferPointers[10];
+
+// Outputs to display
+float gDCLevels[10];
+float gNoiseLevels[10];
+float gNumSamplesAnalysed[10];
+
+// Task to print results which would otherwise be too slow for render()
+AuxiliaryTask gPrintTask;
+
+void printResults();
+
+// setup() is called once before the audio rendering starts.
+// Use it to perform any initialisation and allocation which is dependent
+// on the period size or sample rate.
+//
+// userData holds an opaque pointer to a data structure that was passed
+// in from the call to initAudio().
+//
+// Return true on success; returning false halts the program.
+
+bool setup(BeagleRTContext *context, void *userData)
+{	
+	// Clear the filter data structures
+	for(int i = 0; i < 10; i++) {
+		gBufferPointers[i] = 0;
+		gBuffers[i] = new float[gBufferSize];
+		if(gBuffers[i] == 0) {
+			rt_printf("Error allocating buffer %d\n", i);
+			return false;
+		}
+	}
+	
+	gPrintTask = BeagleRT_createAuxiliaryTask(printResults, 50, "beaglert-print-results");
+
+	return true;
+}
+
+// render() is called regularly at the highest priority by the audio engine.
+// Input and output are given from the audio hardware and the other
+// ADCs and DACs (if available). If only audio is available, numMatrixFrames
+// will be 0.
+
+void render(BeagleRTContext *context, void *userData)
+{
+	bool bufferIsFull = false;	// Whether at least one buffer has filled
+	
+	for(unsigned int n = 0; n < context->audioFrames; n++) {
+		// Store audio inputs in buffer
+		for(unsigned int ch = 0; ch < context->audioChannels; ch++) {
+			if(gBufferPointers[ch] < gBufferSize) {
+				gBuffers[ch][gBufferPointers[ch]] = 
+					context->audioIn[n * context->audioChannels + ch];
+				gBufferPointers[ch]++;
+				if(gBufferPointers[ch] >= gBufferSize)
+					bufferIsFull = true;
+			}
+		}
+	}
+	
+	if(context->analogChannels != 0) {
+		for(unsigned int n = 0; n < context->analogFrames; n++) {
+			// Store analog inputs in buffer, starting at channel 2
+			for(unsigned int ch = 0; ch < context->analogChannels; ch++) {
+				if(gBufferPointers[ch + 2] < gBufferSize) {
+					gBuffers[ch + 2][gBufferPointers[ch + 2]] = 
+						context->analogIn[n * context->analogChannels + ch];
+					gBufferPointers[ch + 2]++;
+					if(gBufferPointers[ch + 2] >= gBufferSize)
+						bufferIsFull = true;
+				}
+			}
+		}	
+	}
+
+	if(bufferIsFull) {
+		// Analyse all active channels at once
+		for(int ch = 0; ch < 10; ch++) {
+			// gBufferPointers[ch] tells us how many samples were stored in the buffer
+			gNumSamplesAnalysed[ch] = gBufferPointers[ch];
+			
+			if(gBufferPointers[ch] != 0) {
+				float mean = 0;
+				for(int n = 0; n < gBufferPointers[ch]; n++) {
+					mean += gBuffers[ch][n];
+				}
+				mean /= (float)gBufferPointers[ch];
+				
+				float rms = 0;
+				for(int n = 0; n < gBufferPointers[ch]; n++) {
+					rms += (gBuffers[ch][n] - mean) * (gBuffers[ch][n] - mean);
+				}				
+				rms = sqrtf(rms / (float)gBufferPointers[ch]);
+				
+				gDCLevels[ch] = mean;
+				gNoiseLevels[ch] = rms;
+			}
+			
+			// Reset pointer to 0 for next time
+			gBufferPointers[ch] = 0;
+		}
+		
+		BeagleRT_scheduleAuxiliaryTask(gPrintTask);
+	}
+}
+
+void printResults()
+{
+	rt_printf("\e[1;1H\e[2J");	// Command to clear the screen
+	
+	// Print the analysis results. channels 0-1 are audio, channels 2-9 are analog
+	for(int ch = 0; ch < 10; ch++) {
+		int samples = gNumSamplesAnalysed[ch];
+		if(samples == 0)
+			continue;
+		
+		if(ch == 0)
+			rt_printf("Audio In L:  ");
+		else if(ch == 1)
+			rt_printf("Audio In R:  ");
+		else
+			rt_printf("Analog In %d: ", ch - 2);
+		
+		rt_printf("Noise %6.1fdB    DC offset %6.4f (%6.1fdB)    window size: %d\n", 
+					20.0f * log10f(gNoiseLevels[ch]),
+					gDCLevels[ch], 
+					20.0f * log10f(fabsf(gDCLevels[ch])),
+					samples);
+	}
+}
+
+// cleanup() is called once at the end, after the audio has stopped.
+// Release any resources that were allocated in setup().
+
+void cleanup(BeagleRTContext *context, void *userData)
+{
+	for(int i = 0; i < 10; i++)
+		delete gBuffers[i];
+}