8magsvn – Diff between revs 25 and 26

(root)/VLF/SW/sidd2/Ix86/sidspect/src/sidspect.c

Rev 25 – Rev 28 – Go to most recent revision – Details – Blame – Last modification – View Log

 #include <math.h>
 #include <fftw3.h>
 static char *device = "plughw:0,0";			/* playback device */
 static snd_pcm_format_t format = SND_PCM_FORMAT_S16;	/* sample format */
-static unsigned int rate = 48000;			/* stream rate */
+static unsigned int rate = 98000;			/* stream rate */
 static unsigned int buffer_time = 130000;		/* ring buffer length in us */
-static unsigned int period_time = 100000;		/* period time in us */
+static unsigned int period_time = 90000;		/* period time in us */
 static int verbose = 0;					/* verbose flag */
 static int resample = 1;				/* enable alsa-lib resampling */
 static int period_event = 0;				/* produce poll event after each period */
 static snd_pcm_sframes_t buffer_size;	// size of buffer at sound card
 double *inl, *inr;
 fftw_complex *outl, *outr;
 fftw_plan fft_plan_left, fft_plan_right;
-double *spect_avg;
+double *spect_avg_left, *spect_avg_right;
 unsigned int period;
 static int set_hwparams(snd_pcm_t *handle, snd_pcm_hw_params_t *params, unsigned int channels)
+{
 	unsigned int rrate;
 /////////// CALL BACK STUFF ///////////////////
 static void async_capture_callback(snd_async_handler_t *ahandler)
+{
 	snd_pcm_t *handle = snd_async_handler_get_pcm(ahandler);
-	int err, n;
+	int err;
-	unsigned int i;
+	unsigned int i, n;
-	short signal[1000000];
+	short signal[100000];
-/*	signal = malloc(sizeof(short) * period_size);
+	/*signal = calloc( (unsigned int) period_size, sizeof(short) );
 	if (signal = NULL) printf("memory allocation failed");*/
 	while (snd_pcm_avail_update(handle) >= period_size) {  // read until data is ready in buffer
 		err = snd_pcm_readi(handle, signal, period_size);
 			exit(EXIT_FAILURE);
+		}
 	n=0;
 	i=0;
-	while(n < period_size){
+	do {
 	  inl[n]= signal[i];
-//	  inr[n]=(double) signal[i+1];
+	  inr[n]= signal[i+1];
 	  n++;
 	  i+=2;
-	}
-/*	fftw_execute(fft_plan_left);
-//	fftw_execute(fft_plan_right);
+	} while (n < period_size);
+	fftw_execute(fft_plan_left);
+	fftw_execute(fft_plan_right);
-	for(i=0; i<(period_size/2 +1); i++) spect_avg[i] += sqrt( (outl[i][0] * outl[i][0]) + (outl[i][1] * outl[i][1]) );
+	for(i=0; i< (period_size/2 +1); i++) spect_avg_left[i] += sqrt( (outl[i][0] * outl[i][0]) + (outl[i][1] * outl[i][1]) ); //acumulate average spectrum
+	for(i=0; i< (period_size/2 +1); i++) spect_avg_right[i] += sqrt( (outr[i][0] * outr[i][0]) + (outr[i][1] * outr[i][1]) ); //acumulate average spectrum
   	period++;
+	}
-	if (period > 1000){
+	if (period > 100){
-	  for(i=0; i<(period_size/2 +1); i++) spect_avg[i] = spect_avg[i]/1000;
+	  for(i=0; i<(period_size/2 +1); i++) spect_avg_left[i] = spect_avg_left[i]/100;
+	  for(i=0; i<(period_size/2 +1); i++) spect_avg_right[i] = spect_avg_right[i]/100;
-	  out=fopen("./output.txt","w");
+	  out=fopen("/tmp/sidspect","w");
-    	  for(i=0; i<(period_size/2 +1); i++) fprintf(out,"%6f\n",spect_avg[i]);
+    	  for(i=0; i< (period_size/2 +1); i++) fprintf(out,"%u %6f %6f\n",i, spect_avg_left[i], spect_avg_right[i]);
           fclose(out);
-	  period=0;*/
+	  period=0;
+	}
-	free(signal);
+//	free(signal);
+}
 int main(int argc, char *argv[])
+{
 	snd_pcm_channel_area_t *areas;
 	struct async_private_data data;
 	snd_async_handler_t *chandler;
-	int count;
-	unsigned int i,j;
 	snd_pcm_hw_params_alloca(&hwparams);
 	snd_pcm_sw_params_alloca(&swparams);
 	printf("SID monitor 2.0 starting work.. \n");
 	if ((err = set_swparams(capture_handle, swparams)) < 0) {
 		printf("Setting of swparams failed: %s\n", snd_strerror(err));
 		exit(EXIT_FAILURE);
+	}
-	spect_avg = calloc((unsigned int)(period_size/2 + 1), sizeof (double));
+	spect_avg_left = calloc((period_size/2 + 1), sizeof (double));
+	spect_avg_right = calloc((period_size/2 + 1), sizeof (double));
 // register capture callback
 	err = snd_async_add_pcm_handler(&chandler, capture_handle, async_capture_callback, &data); // fill by dummy &data
 	if (err < 0) {
 		printf("Unable to register async handler\n");
 		exit(EXIT_FAILURE);
+	}
-	inl = fftw_malloc(sizeof(double) * 100000); // period_size);
+	inl = fftw_malloc(sizeof(double) * period_size); // period_size);
-        outl = fftw_malloc(sizeof(fftw_complex) * (period_size/2 +1) );
+        outl = fftw_malloc(sizeof(fftw_complex) * (period_size/2 + 1));
+	inr = fftw_malloc(sizeof(double) * period_size); // period_size);
+        outr = fftw_malloc(sizeof(fftw_complex) * (period_size/2 + 1));
-	fft_plan_left = fftw_plan_dft_r2c_1d(period_size, inl, outr, FFTW_ESTIMATE);
+	fft_plan_left = fftw_plan_dft_r2c_1d(period_size, inl, outl, FFTW_ESTIMATE);
-//	fft_plan_right = fftw_plan_dft_r2c_1d(period_size, in, out, FFTW_ESTIMATE);
+	fft_plan_right = fftw_plan_dft_r2c_1d(period_size, inr, outr, FFTW_ESTIMATE);
 	period=0;
 //start capture
 	if ((err = snd_pcm_prepare (capture_handle)) < 0) {
 		fprintf (stderr, "cannot prepare audio interface for use (%s)\n",
 			 snd_strerror (err));
 		exit (1);