/* This software is part of libcsdr, a set of simple DSP routines for Software Defined Radio. Copyright (c) 2014, Andras Retzler All rights reserved. Redistribution and use in source and binary forms, with or without modification, are permitted provided that the following conditions are met: * Redistributions of source code must retain the above copyright notice, this list of conditions and the following disclaimer. * Redistributions in binary form must reproduce the above copyright notice, this list of conditions and the following disclaimer in the documentation and/or other materials provided with the distribution. * Neither the name of the copyright holder nor the names of its contributors may be used to endorse or promote products derived from this software without specific prior written permission. THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL ANDRAS RETZLER BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */ #define _POSIX_C_SOURCE 199309L #define _BSD_SOURCE #include #include #include #include #include #include #include #include #include #include #include #include #include "libcsdr.h" #include "libcsdr_gpl.h" #include "ima_adpcm.h" #include #include char usage[]= "csdr - a simple commandline tool for Software Defined Radio receiver DSP.\n\n" "usage: \n\n" " csdr function_name [optional_param] ...\n\n" "list of functions:\n\n" " convert_u8_f\n" " convert_f_u8\n" " convert_f_i16\n" " convert_i16_f\n" " realpart_cf\n" " clipdetect_ff\n" " limit_ff [max_amplitude]\n" " gain_ff \n" " clone\n" " none\n" " yes_f [buf_times]\n" " detect_nan_ff\n" " floatdump_f\n" " flowcontrol \n" " shift_math_cc \n" " shift_addition_cc \n" " shift_addition_cc_test\n" " shift_table_cc [table_size]\n" " decimating_shift_addition_cc [decimation]\n" " dcblock_ff\n" " fastdcblock_ff\n" " fmdemod_atan_cf\n" " fmdemod_quadri_cf\n" " fmdemod_quadri_novect_cf\n" " deemphasis_wfm_ff " " deemphasis_nfm_ff " " amdemod_cf\n" " amdemod_estimator_cf\n" " fir_decimate_cc [transition_bw [window]]\n" " firdes_lowpass_f [window [--octave]]\n" " firdes_bandpass_c [window [--octave]]\n" " agc_ff [hang_time [reference [attack_rate [decay_rate [max_gain [attack_wait [filter_alpha]]]]]]]\n" " fastagc_ff [block_size [reference]]" " rational_resampler_ff [transition_bw [window]]\n" " fractional_decimator_ff [transition_bw [window]]\n" " fft_cc [window [--octave] [--benchmark]]\n" " logpower_cf [add_db]\n" " fft_benchmark [--benchmark]\n" " bandpass_fir_fft_cc [window]\n" " encode_ima_adpcm_i16_u8\n" " decode_ima_adpcm_u8_i16\n" " compress_fft_adpcm_f_u8 \n" " fft_exchange_sides_ff \n" " \n" ; #define BUFSIZE (1024) #define BIG_BUFSIZE (1024*16) //should be multiple of 16! (size of double complex) //also, keep in mind that shift_addition_cc works better the smaller this buffer is. #define YIELD_EVERY_N_TIMES 3 #define TRY_YIELD if(++yield_counter%YIELD_EVERY_N_TIMES==0) sched_yield() unsigned yield_counter=0; int badsyntax(char* why) { if(why==0) fprintf(stderr, "%s", usage); else fprintf(stderr, "%s\n\n", why); return -1; } int clipdetect_ff(float* input, int input_size) { for(int i=0;i1.0) { fprintf(stderr, "clipdetect_ff: Signal value above 1.0!\n"); return 1; } } return 0; } int clone() { static unsigned char clone_buffer[BUFSIZE]; for(;;) { fread(clone_buffer, sizeof(unsigned char), BUFSIZE, stdin); fwrite(clone_buffer, sizeof(unsigned char), BUFSIZE, stdout); TRY_YIELD; } } #define FREAD_R fread(input_buffer, sizeof(float), BUFSIZE, stdin) #define FREAD_C fread(input_buffer, sizeof(float)*2, BUFSIZE, stdin) #define FWRITE_R fwrite(output_buffer, sizeof(float), BUFSIZE, stdout) #define FWRITE_C fwrite(output_buffer, sizeof(float)*2, BUFSIZE, stdout) #define FEOF_CHECK if(feof(stdin)) return 0 #define BIG_FREAD_C fread(input_buffer, sizeof(float)*2, BIG_BUFSIZE, stdin) #define BIG_FWRITE_C fwrite(output_buffer, sizeof(float)*2, BIG_BUFSIZE, stdout) int init_fifo(int argc, char *argv[]) { if(argc>=4) { if(!strcmp(argv[2],"--fifo")) { fprintf(stderr,"csdr: fifo control mode on\n"); int fd = open(argv[3], O_RDONLY); int flags = fcntl(fd, F_GETFL, 0); fcntl(fd, F_SETFL, flags | O_NONBLOCK); return fd; } } return 0; } #define RFCTL_BUFSIZE 1024 int read_fifo_ctl(int fd, char* format, ...) { if(!fd) return 0; static char buffer[RFCTL_BUFSIZE]; static int buffer_index=0; int bytes_read=read(fd,buffer+buffer_index,(RFCTL_BUFSIZE-buffer_index)*sizeof(char)); if(bytes_read<=0) return 0; int prev_newline_at=0; int last_newline_at=0; for(int i=0;i=3) sscanf(argv[2],"%g",&max_amplitude); for(;;) { FEOF_CHECK; FREAD_R; limit_ff(input_buffer, output_buffer, BUFSIZE, max_amplitude); FWRITE_R; TRY_YIELD; } } if(!strcmp(argv[1],"yes_f")) { if(argc<=2) return badsyntax("need required parameter (to_repeat)"); float to_repeat; sscanf(argv[2],"%g",&to_repeat); int buf_times = 0; if(argc>=4) sscanf(argv[3],"%d",&buf_times); for(int i=0;i/dev/null //csdr yes_f 1 1000000 | time csdr shift_addition_cc 0.2 >/dev/null //csdr yes_f 1 1000000 | time csdr shift_table_cc 0.2 >/dev/null if(!strcmp(argv[1],"shift_table_cc")) { if(argc<=2) return badsyntax("need required parameter (rate)"); float starting_phase=0; float rate; int table_size=65536; sscanf(argv[2],"%g",&rate); if(argc>3) sscanf(argv[3],"%d",&table_size); shift_table_data_t table_data=shift_table_init(table_size); fprintf(stderr,"shift_table_cc: LUT initialized\n"); for(;;) { FEOF_CHECK; if(!BIG_FREAD_C) break; starting_phase=shift_table_cc((complexf*)input_buffer, (complexf*)output_buffer, BIG_BUFSIZE, rate, table_data, starting_phase); BIG_FWRITE_C; TRY_YIELD; } return 0; } #ifdef LIBCSDR_GPL if(!strcmp(argv[1],"decimating_shift_addition_cc")) { if(argc<=2) return badsyntax("need required parameter (rate)"); float starting_phase=0; float rate; int decimation=1; sscanf(argv[2],"%g",&rate); if(argc>3) sscanf(argv[3],"%d",&decimation); shift_addition_data_t d=decimating_shift_addition_init(rate, decimation); decimating_shift_addition_status_t s; s.decimation_remain=0; s.starting_phase=0; for(;;) { FEOF_CHECK; if(!BIG_FREAD_C) break; s=decimating_shift_addition_cc((complexf*)input_buffer, (complexf*)output_buffer, BIG_BUFSIZE, d, decimation, s); fwrite(output_buffer, sizeof(float)*2, s.output_size, stdout); TRY_YIELD; } return 0; } if(!strcmp(argv[1],"shift_addition_cc")) { float starting_phase=0; float rate; int fd; if(fd=init_fifo(argc,argv)) { while(!read_fifo_ctl(fd,"%g\n",&rate)) usleep(10000); } else { if(argc<=2) return badsyntax("need required parameter (rate)"); sscanf(argv[2],"%g",&rate); } for(;;) { shift_addition_data_t data=shift_addition_init(rate); fprintf(stderr,"shift_addition_cc: reinitialized to %g\n",rate); for(;;) { FEOF_CHECK; if(!BIG_FREAD_C) break; starting_phase=shift_addition_cc((complexf*)input_buffer, (complexf*)output_buffer, BIG_BUFSIZE, data, starting_phase); BIG_FWRITE_C; if(read_fifo_ctl(fd,"%g\n",&rate)) break; TRY_YIELD; } } return 0; } if(!strcmp(argv[1],"shift_addition_cc_test")) { if(argc<=2) return badsyntax("need required parameter (rate)"); float rate; sscanf(argv[2],"%g",&rate); shift_addition_data_t data=shift_addition_init(rate); shift_addition_cc_test(data); return 0; } #endif if(!strcmp(argv[1],"dcblock_ff")) { static dcblock_preserve_t dcp; //will be 0 as .bss is set to 0 for(;;) { FEOF_CHECK; FREAD_R; dcp=dcblock_ff(input_buffer, output_buffer, BUFSIZE, 0, dcp); FWRITE_R; TRY_YIELD; } } if(!strcmp(argv[1],"fastdcblock_ff")) { int dcblock_bufsize=BUFSIZE; if(argc>=3) sscanf(argv[2],"%d",&dcblock_bufsize); float* dcblock_buffer=(float*)malloc(sizeof(float)*dcblock_bufsize); static float last_dc_level=0.0; for(;;) { FEOF_CHECK; fread(dcblock_buffer, sizeof(float), dcblock_bufsize, stdin); last_dc_level=fastdcblock_ff(dcblock_buffer, dcblock_buffer, dcblock_bufsize, last_dc_level); fwrite(dcblock_buffer, sizeof(float), dcblock_bufsize, stdout); TRY_YIELD; } } if(!strcmp(argv[1],"fmdemod_atan_cf")) { float last_phase=0; for(;;) { FEOF_CHECK; FREAD_C; if(feof(stdin)) return 0; last_phase=fmdemod_atan_cf((complexf*)input_buffer, output_buffer, BUFSIZE, last_phase); FWRITE_R; TRY_YIELD; } } if(!strcmp(argv[1],"fmdemod_quadri_cf")) { complexf last_sample; last_sample.i=0.; last_sample.q=0.; for(;;) { FEOF_CHECK; FREAD_C; last_sample=fmdemod_quadri_cf((complexf*)input_buffer, output_buffer, BUFSIZE, temp_f, last_sample); FWRITE_R; TRY_YIELD; } } if(!strcmp(argv[1],"fmdemod_quadri_novect_cf")) { complexf last_sample; last_sample.i=0.; last_sample.q=0.; for(;;) { FEOF_CHECK; FREAD_C; last_sample=fmdemod_quadri_novect_cf((complexf*)input_buffer, output_buffer, BUFSIZE, last_sample); FWRITE_R; TRY_YIELD; } } if(!strcmp(argv[1],"deemphasis_wfm_ff")) { if(argc<=3) return badsyntax("need required parameters (sample rate, tau)"); int sample_rate; sscanf(argv[2],"%d",&sample_rate); float tau; sscanf(argv[3],"%g",&tau); fprintf(stderr,"deemphasis_wfm_ff: tau = %g, sample_rate = %d\n",tau,sample_rate); float last_output=0; for(;;) { FEOF_CHECK; FREAD_R; last_output=deemphasis_wfm_ff(input_buffer, output_buffer, BUFSIZE, tau, sample_rate, last_output); FWRITE_R; TRY_YIELD; } } if(!strcmp(argv[1],"detect_nan_ff")) { for(;;) { FEOF_CHECK; FREAD_R; int nan_detect=0; for(int i=0; i=4) sscanf(argv[3],"%g",&transition_bw); window_t window = WINDOW_DEFAULT; if(argc>=5) { window=firdes_get_window_from_string(argv[4]); } else fprintf(stderr,"fir_decimate_cc: window = %s\n",firdes_get_string_from_window(window)); int taps_length=firdes_filter_len(transition_bw); fprintf(stderr,"fir_decimate_cc: taps_length = %d\n",taps_length); float *taps=(float*)malloc(taps_length*sizeof(float)); firdes_lowpass_f(taps,taps_length,0.5/(float)factor,window); int input_skip=0; int output_size=0; FREAD_C; for(;;) { FEOF_CHECK; output_size=fir_decimate_cc((complexf*)input_buffer, (complexf*)output_buffer, BIG_BUFSIZE, factor, taps, taps_length); fwrite(output_buffer, sizeof(complexf), output_size, stdout); fflush(stdout); TRY_YIELD; input_skip=factor*output_size; memmove((complexf*)input_buffer,((complexf*)input_buffer)+input_skip,(BIG_BUFSIZE-input_skip)*sizeof(complexf)); //memmove lets the source and destination overlap fread(((complexf*)input_buffer)+(BIG_BUFSIZE-input_skip), sizeof(complexf), input_skip, stdin); //fprintf(stderr,"iskip=%d output_size=%d start=%x target=%x skipcount=%x \n",input_skip,output_size,input_buffer, ((complexf*)input_buffer)+(BIG_BUFSIZE-input_skip),(BIG_BUFSIZE-input_skip)); } } /*if(!strcmp(argv[1],"ejw_test")) { printf("ejqd=["); complexf ejw; float phase=0; for(int i=0;i<63;i++) { e_powj(&ejw,phase); phase+=PI*0.3; printf("%g+(%g)*i ",iof(&ejw,0),qof(&ejw,0)); } printf("];"); return 0; }*/ if(!strcmp(argv[1],"firdes_lowpass_f")) { //Process the params if(argc<=3) return badsyntax("need required parameters (cutoff_rate, length)"); float cutoff_rate; sscanf(argv[2],"%g",&cutoff_rate); int length; sscanf(argv[3],"%d",&length); if(length%2==0) return badsyntax("number of symmetric FIR filter taps should be odd"); window_t window = WINDOW_DEFAULT; if(argc>=5) { window=firdes_get_window_from_string(argv[4]); } else fprintf(stderr,"firdes_lowpass_f: window = %s\n",firdes_get_string_from_window(window)); int octave=(argc>=6 && !strcmp("--octave",argv[5])); float* taps=(float*)malloc(sizeof(float)*length); //Make the filter firdes_lowpass_f(taps,length,cutoff_rate,window); //Do the output if(octave) printf("taps=["); for(int i=0;i=6) { window=firdes_get_window_from_string(argv[5]); } else fprintf(stderr,"firdes_bandpass_c: window = %s\n",firdes_get_string_from_window(window)); int octave=(argc>=7 && !strcmp("--octave",argv[6])); complexf* taps=(complexf*)malloc(sizeof(complexf)*length); //Make the filter firdes_bandpass_c(taps, length, low_cut, high_cut, window); //Do the output if(octave) printf("taps=["); for(int i=0;i=3) sscanf(argv[2],"%hd",&hang_time); float reference=0.5; if(argc>=4) sscanf(argv[3],"%g",&reference); float attack_rate=0.01; if(argc>=5) sscanf(argv[4],"%g",&attack_rate); float decay_rate=0.0001; if(argc>=6) sscanf(argv[5],"%g",&decay_rate); float max_gain=65536; if(argc>=7) sscanf(argv[6],"%g",&max_gain); short attack_wait=0; if(argc>=8) sscanf(argv[7],"%hd",&attack_wait); float filter_alpha=0.999;//0.001; if(argc>=9) sscanf(argv[8],"%g",&filter_alpha); float last_gain=1.0; for(;;) { FEOF_CHECK; FREAD_R; last_gain=agc_ff(input_buffer, output_buffer, BUFSIZE, reference, attack_rate, decay_rate, max_gain, hang_time, attack_wait, filter_alpha, last_gain); FWRITE_R; TRY_YIELD; } } #endif if(!strcmp(argv[1],"fastagc_ff")) { static fastagc_ff_t input; //is in .bss and gets cleared to zero before main() input.input_size=1024; if(argc>=3) sscanf(argv[2],"%d",&input.input_size); input.reference=1.0; if(argc>=4) sscanf(argv[3],"%g",&input.reference); input.buffer_1=(float*)calloc(input.input_size,sizeof(float)); input.buffer_2=(float*)calloc(input.input_size,sizeof(float)); input.buffer_input=(float*)malloc(sizeof(float)*input.input_size); float* agc_output_buffer=(float*)malloc(sizeof(float)*input.input_size); for(;;) { FEOF_CHECK; fread(input.buffer_input, sizeof(float), input.input_size, stdin); fastagc_ff(&input, agc_output_buffer); fwrite(agc_output_buffer, sizeof(float), input.input_size, stdout); TRY_YIELD; } } int suboptimal; if( (suboptimal=!strcmp(argv[1],"suboptimal_rational_resampler_ff"))||(!strcmp(argv[1],"rational_resampler_ff")) ) { //last@2014-11-06: ./docompile; ./csdr yes_f 1.0 | ./csdr suboptimal_rational_resampler_ff 5 2 //Process the params if(argc<=3) return badsyntax("need required parameters (interpolation, decimation)"); int interpolation; sscanf(argv[2],"%d",&interpolation); int decimation; sscanf(argv[3],"%d",&decimation); float transition_bw=0.05; if(argc>=5) sscanf(argv[4],"%g",&transition_bw); window_t window = WINDOW_DEFAULT; if(argc>=6) { window=firdes_get_window_from_string(argv[5]); } else fprintf(stderr,"rational_resampler_ff: window = %s\n",firdes_get_string_from_window(window)); if(suboptimal) fprintf(stderr,"note: suboptimal rational resampler chosen.\n"); if(decimation==1&&interpolation==1) clone(); //copy input to output in this special case (and stick in this function). //Alloc output buffer int resampler_output_buffer_size=(BUFSIZE*interpolation)/decimation; float* resampler_output_buffer=(float*)malloc(sizeof(float)*resampler_output_buffer_size); float* suboptimal_resampler_temp_buffer = (suboptimal)?(float*)malloc(sizeof(float)*BUFSIZE*interpolation):NULL; //Generate filter taps int taps_length = firdes_filter_len(transition_bw); float* taps = (float*)malloc(sizeof(float)*taps_length); rational_resampler_get_lowpass_f(taps, taps_length, interpolation, decimation, window); static rational_resampler_ff_t d; //in .bss => initialized to zero for(;;) { FEOF_CHECK; if(d.input_processed==0) d.input_processed=BUFSIZE; else memcpy(input_buffer, input_buffer+d.input_processed, sizeof(float)*(BUFSIZE-d.input_processed)); fread(input_buffer+(BUFSIZE-d.input_processed), sizeof(float), d.input_processed, stdin); //if(suboptimal) d=suboptimal_rational_resampler_ff(input_buffer, resampler_output_buffer, BUFSIZE, interpolation, decimation, taps, taps_length, suboptimal_resampler_temp_buffer); else d=rational_resampler_ff(input_buffer, resampler_output_buffer, BUFSIZE, interpolation, decimation, taps, taps_length, d.last_taps_delay); //fprintf(stderr,"resampled %d %d, %d\n",d.output_size, d.input_processed, d.input_processed); fwrite(resampler_output_buffer, sizeof(float), d.output_size, stdout); TRY_YIELD; } } if(!strcmp(argv[1],"fractional_decimator_ff")) { //Process the params if(argc<=2) return badsyntax("need required parameters (rate)"); float rate; sscanf(argv[2],"%g",&rate); float transition_bw=0.03; if(argc>=4) sscanf(argv[3],"%g",&transition_bw); window_t window = WINDOW_DEFAULT; if(argc>=5) { window = firdes_get_window_from_string(argv[4]); } else fprintf(stderr,"fractional_decimator_ff: window = %s\n",firdes_get_string_from_window(window)); if(rate==1) clone(); //copy input to output in this special case (and stick in this function). //Generate filter taps int taps_length = firdes_filter_len(transition_bw); fprintf(stderr,"fractional_decimator_ff: taps_length = %d\n",taps_length); float* taps = (float*)malloc(sizeof(float)*taps_length); firdes_lowpass_f(taps, taps_length, 0.59*0.5/(rate-transition_bw), window); //0.6 const to compensate rolloff //for(int=0;i initialized to zero for(;;) { FEOF_CHECK; if(d.input_processed==0) d.input_processed=BUFSIZE; else memcpy(input_buffer, input_buffer+d.input_processed, sizeof(float)*(BUFSIZE-d.input_processed)); fread(input_buffer+(BUFSIZE-d.input_processed), sizeof(float), d.input_processed, stdin); d = fractional_decimator_ff(input_buffer, output_buffer, BUFSIZE, rate, taps, taps_length, d); fwrite(output_buffer, sizeof(float), d.output_size, stdout); TRY_YIELD; } } if(!strcmp(argv[1],"fft_cc")) { if(argc<=3) return badsyntax("need required parameters (fft_size, out_of_every_n_samples)"); int fft_size; sscanf(argv[2],"%d",&fft_size); if(log2n(fft_size)==-1) return badsyntax("fft_size should be power of 2"); int every_n_samples; sscanf(argv[3],"%d",&every_n_samples); int benchmark=0; int octave=0; window_t window = WINDOW_DEFAULT; if(argc>=5) { window=firdes_get_window_from_string(argv[4]); } if(argc>=6) { benchmark|=!strcmp("--benchmark",argv[5]); octave|=!strcmp("--octave",argv[5]); } if(argc>=7) { benchmark|=!strcmp("--benchmark",argv[6]); octave|=!strcmp("--octave",argv[6]); } //make FFT plan complexf* input=(complexf*)fft_malloc(sizeof(complexf)*fft_size); complexf* windowed=(complexf*)fft_malloc(sizeof(complexf)*fft_size); complexf* output=(complexf*)fft_malloc(sizeof(complexf)*fft_size); if(benchmark) fprintf(stderr,"fft_cc: benchmarking..."); FFT_PLAN_T* plan=make_fft_c2c(fft_size, windowed, output, 1, benchmark); if(benchmark) fprintf(stderr," done\n"); if(octave) printf("setenv(\"GNUTERM\",\"X11 noraise\");y=zeros(1,%d);semilogy(y,\"ydatasource\",\"y\");\n",fft_size); for(;;) { FEOF_CHECK; if(every_n_samples>fft_size) { fread(input, sizeof(complexf), fft_size, stdin); //skipping samples before next FFT (but fseek doesn't work for pipes) for(int seek_remain=every_n_samples-fft_size;seek_remain>0;seek_remain-=BUFSIZE) { fread(temp_f, sizeof(complexf), MIN_M(BUFSIZE,seek_remain), stdin); } } else { //overlapped FFT for(int i=0;i=3) sscanf(argv[2],"%g",&add_db); for(;;) { FEOF_CHECK; fread(input_buffer, sizeof(complexf), LOGPOWERCF_BUFSIZE, stdin); logpower_cf((complexf*)input_buffer,output_buffer,LOGPOWERCF_BUFSIZE,add_db); fwrite(output_buffer, sizeof(float), LOGPOWERCF_BUFSIZE, stdout); //bufsize is so small, I don't dare to TRY_YIELD } } if(!strcmp(argv[1],"fft_exchange_sides_ff")) { if(argc<=2) return badsyntax("need required parameters (fft_size)"); int fft_size; sscanf(argv[2],"%d",&fft_size); float* input_buffer_s1 = (float*)malloc(sizeof(float)*fft_size/2); float* input_buffer_s2 = (float*)malloc(sizeof(float)*fft_size/2); for(;;) { FEOF_CHECK; fread(input_buffer_s1, sizeof(float), fft_size/2, stdin); fread(input_buffer_s2, sizeof(float), fft_size/2, stdin); fwrite(input_buffer_s2, sizeof(float), fft_size/2, stdout); fwrite(input_buffer_s1, sizeof(float), fft_size/2, stdout); TRY_YIELD; } } #ifdef USE_IMA_ADPCM #define COMPRESS_FFT_PAD_N 10 //We will pad the FFT at the beginning, with the first value of the input data, COMPRESS_FFT_PAD_N times. //No, this is not advanced DSP, just the ADPCM codec produces some gabarge samples at the beginning, //so we just add data to become garbage and get skipped. //COMPRESS_FFT_PAD_N should be even. if(!strcmp(argv[1],"compress_fft_adpcm_f_u8")) { if(argc<=2) return badsyntax("need required parameters (fft_size)"); int fft_size; sscanf(argv[2],"%d",&fft_size); int real_data_size=fft_size+COMPRESS_FFT_PAD_N; float* input_buffer_cwa = (float*)malloc(sizeof(float)*real_data_size); short* temp_buffer_cwa = (short*)malloc(sizeof(short)*real_data_size); unsigned char* output_buffer_cwa = (unsigned char*)malloc(sizeof(unsigned char)*(real_data_size/2)); ima_adpcm_state_t d; d.index=d.previousValue=0; for(;;) { FEOF_CHECK; fread(input_buffer_cwa+COMPRESS_FFT_PAD_N, sizeof(float), fft_size, stdin); for(int i=0;i=5)&&!strcmp(argv[4],"--benchmark"); fprintf(stderr,"fft_benchmark: FFT library used: %s\n",FFT_LIBRARY_USED); complexf* input=(complexf*)fft_malloc(sizeof(complexf)*fft_size); complexf* output=(complexf*)fft_malloc(sizeof(complexf)*fft_size); //fill input with random data srand(time(NULL)); for(int i=0;i=6) window=firdes_get_window_from_string(argv[5]); else fprintf(stderr,"bandpass_fir_fft_cc: window = %s\n",firdes_get_string_from_window(window)); //calculate the FFT size and the other length parameters int taps_length=firdes_filter_len(transition_bw); //the number of non-zero taps int fft_size=next_pow2(taps_length); //we will have to pad the taps with zeros until the next power of 2 for FFT //the number of padding zeros is the number of output samples we will be able to take away after every processing step, and it looks sane to check if it is large enough. if (fft_size-taps_length<200) fft_size<<=1; int input_size = fft_size - taps_length + 1; int overlap_length = taps_length - 1; fprintf(stderr,"bandpass_fir_fft_cc: (fft_size = %d) = (taps_length = %d) + (input_size = %d) - 1\n(overlap_length = %d) = taps_length - 1\n", fft_size, taps_length, input_size, overlap_length); if (fft_size<=2) return badsyntax("FFT size error."); //prepare making the filter and doing FFT on it complexf* taps=(complexf*)calloc(sizeof(complexf),fft_size); //initialize to zero complexf* taps_fft=(complexf*)malloc(sizeof(complexf)*fft_size); FFT_PLAN_T* plan_taps = make_fft_c2c(fft_size, taps, taps_fft, 1, 0); //forward, don't benchmark (we need this only once) //make FFT plans for continously processing the input complexf* input = fft_malloc(fft_size*sizeof(complexf)); complexf* input_fourier = fft_malloc(fft_size*sizeof(complexf)); FFT_PLAN_T* plan_forward = make_fft_c2c(fft_size, input, input_fourier, 1, 1); //forward, do benchmark complexf* output_fourier = fft_malloc(fft_size*sizeof(complexf)); complexf* output_1 = fft_malloc(fft_size*sizeof(complexf)); complexf* output_2 = fft_malloc(fft_size*sizeof(complexf)); //we create 2x output buffers so that one will preserve the previous overlap: FFT_PLAN_T* plan_inverse_1 = make_fft_c2c(fft_size, output_fourier, output_1, 0, 1); //inverse, do benchmark FFT_PLAN_T* plan_inverse_2 = make_fft_c2c(fft_size, output_fourier, output_2, 0, 1); //we initialize this buffer to 0 as it will be taken as the overlap source for the first time: for(int i=0;ioutput,i)=qof(plan_inverse_2->output,i)=0; for(int i=input_size;ioutput + input_size; //+ fft_size - overlap_length; apply_fir_fft_cc (plan_forward, plan_inverse, taps_fft, last_overlap, overlap_length); int returned=fwrite(plan_inverse->output, sizeof(complexf), input_size, stdout); if(read_fifo_ctl(fd,"%g %g\n",&low_cut,&high_cut)) break; TRY_YIELD; } } } #ifdef USE_IMA_ADPCM #define IMA_ADPCM_BUFSIZE BUFSIZE if(!strcmp(argv[1],"encode_ima_adpcm_i16_u8")) { ima_adpcm_state_t d; d.index=d.previousValue=0; for(;;) { FEOF_CHECK; fread(buffer_i16, sizeof(short), IMA_ADPCM_BUFSIZE, stdin); d=encode_ima_adpcm_i16_u8(buffer_i16, buffer_u8, IMA_ADPCM_BUFSIZE, d); fwrite(buffer_u8, sizeof(unsigned char), IMA_ADPCM_BUFSIZE/2, stdout); TRY_YIELD; } } if(!strcmp(argv[1],"decode_ima_adpcm_u8_i16")) { ima_adpcm_state_t d; d.index=d.previousValue=0; for(;;) { FEOF_CHECK; fread(buffer_u8, sizeof(unsigned char), IMA_ADPCM_BUFSIZE/2, stdin); d=decode_ima_adpcm_u8_i16(buffer_u8, buffer_i16, IMA_ADPCM_BUFSIZE/2, d); fwrite(buffer_i16, sizeof(short), IMA_ADPCM_BUFSIZE, stdout); TRY_YIELD; } } #endif if(!strcmp(argv[1],"flowcontrol")) { if(argc<=3) return badsyntax("need required parameters (data_rate, reads_per_seconds)"); int data_rate; sscanf(argv[2],"%d",&data_rate); int reads_per_second; sscanf(argv[3],"%d",&reads_per_second); int flowcontrol_bufsize=ceil(1.*(double)data_rate/reads_per_second); unsigned char* flowcontrol_buffer = (unsigned char*)malloc(sizeof(unsigned char)*flowcontrol_bufsize); int flowcontrol_sleep=floor(1000000./reads_per_second); fprintf(stderr, "flowcontrol: flowcontrol_bufsize = %d, flowcontrol_sleep = %d\n", flowcontrol_bufsize, flowcontrol_sleep); for(;;) { FEOF_CHECK; fread(flowcontrol_buffer, sizeof(unsigned char), flowcontrol_bufsize, stdin); fwrite(flowcontrol_buffer, sizeof(unsigned char), flowcontrol_bufsize, stdout); usleep(flowcontrol_sleep); TRY_YIELD; } } if(!strcmp(argv[1],"none")) { return 0; } return badsyntax("function name given in argument 1 does not exist."); }