|
|
发表于 2024-7-17 11:49:30
|
显示全部楼层
- xSemaphoreHandle xRXDSP;
- xSemaphoreHandle xRXIN;
- xSemaphoreHandle xRXOUT;
- int * input_buffer_ptr = &input_buffer[NUM_SAMPLE_BUF/2].re;
- void IRAM_ATTR rx_in(void * pvParameters){
- size_t readsize = 0;
-
- while (true) {
- #ifdef DEBUG_RUN
- int rx_time = micros();
- #endif
- xSemaphoreTake(xRXIN, portMAX_DELAY);//ждем сигнала от dsp-обработчика о готвности премного буфера для приема след.партии отсчетов
- #ifdef DEBUG_RUN
- if (access_in_wait){rx_in_wait_result = micros()-rx_time;access_in_wait=false;}
- rx_time = micros();
- #endif
- //копирование ранее принятых отсчетов из старшей части рабочего буфера в младшую (50% overlap&save)
- for (int i=0;i<NUM_SAMPLE_BUF;i++){
- workbuf_in[i].re = workbuf_tmp[i].re;
- workbuf_in[i].im = workbuf_tmp[i].im;
- }
- //прием след.порции отсчетов и перенос в старшую часть рабочего буфера
- if(current_mode==RX_MODE)i2s_read(I2S_NUM_0, &input_buffer, sizeof(input_buffer), &readsize, portMAX_DELAY);
- for (int i=0; i<NUM_SAMPLE_BUF; i++) {
- workbuf_in[i+NUM_SAMPLE_BUF].re = workbuf_tmp[i].re = (float)(input_buffer[i].re>>12);
- workbuf_in[i+NUM_SAMPLE_BUF].im = workbuf_tmp[i].im = (float)(input_buffer[i].im>>12);
- fft_in[i].re = workbuf_tmp[i].re;//заполняем fft-буфер для панорамы и спектра
- fft_in[i].im = workbuf_tmp[i].im;
- }
- fft_for_display((float*)&fft_in);//вычислить магнитуды для спектра и "водопада" для последующего отображения
- #ifdef DEBUG_RUN
- if (access_in_run){rx_in_run_result = micros()-rx_time;access_in_run=false;}
- #endif
- if(current_mode==RX_MODE){xSemaphoreGive(xRXDSP);}//разрешаем демодуляцию и фильтрацию рабочего буфера
- }
- }
- void IRAM_ATTR rx_out(void * pvParameters){
- size_t readsize = 0;
- while(true){
- #ifdef DEBUG_RUN
- int rx_time = micros();
- #endif
- xSemaphoreTake(xRXOUT, portMAX_DELAY);//ждем окончания dsp-обработки
- #ifdef DEBUG_RUN
- if (access_out_wait){rx_out_wait_result = micros()-rx_time;access_out_wait=false;}
- rx_time = micros();
- #endif
- if(!agc)agc_koeff=1.0f;//
- for (int i=0; i<NUM_SAMPLE_BUF; i++) { //переносим обработанный массив в выходной буфер с нормализацией в I2S-формат
- output_buffer[i].re = speak_out ? ((int)(workbuf_out[i].re*agc_koeff))<<12: 0;
- output_buffer[i].im = speak_out ? ((int)(workbuf_out[i].im*agc_koeff))<<12: 0;
- }
- xSemaphoreGive(xRXIN);
- if(current_mode==RX_MODE)i2s_write(I2S_NUM_0, &output_buffer, sizeof(output_buffer), &readsize, portMAX_DELAY );//вывод звука
- #ifdef DEBUG_RUN
- if (access_out_run){rx_out_run_result = micros()-rx_time;access_out_run=false;}
- #endif
- }
- }
- uint32_t IRAM_ATTR S_metr_ssb(float* input)
- {
- int bins = bandwidth/(I2S_SAMPLE_RATE/NUM_SAMPLE_BUF);
- int bin_start = indent/(I2S_SAMPLE_RATE/NUM_SAMPLE_BUF);
- float tmp=0;
- float S_metr_buf=0;
- float beta=0.99f;
- float alpha=(1-beta);
- for (int i=bin_start*2;i<(bins+bin_start)*2;i+=2)
- {
- if (input[i]<0){tmp=-input[i];}else{tmp=input[i];}
- S_metr_buf=(S_metr_buf*beta)+(alpha*tmp);
- }
-
- int32_t level=(int32_t)(2.0f*sqrtf((S_metr_buf/bins)));
- if (level<=0)level=0;
- if (level>150)level=150;
- return level;
- }
- void IRAM_ATTR get_ssb(int pos,struct COMPLEX* input){//демодуляция SSB в частотной области
- switch (rf_mode){
- case LSB: //
- for (int i=0;i<NUM_FFT_BUF/2;i++) {
- input[i].re = input[pos*2-i].re;
- input[i].im = -input[pos*2-i].im;
- }
- break;
- case USB: //
- for (int i=0;i<NUM_FFT_BUF/2;i++) {
- input[i].re = input[pos*2+i].re;
- input[i].im = input[pos*2+i].im;
- }
- break;
- }
- for (int i=NUM_FFT_BUF/2;i<NUM_FFT_BUF;i++) {//обнуляем отрицательные частоты
- input[i].re = input[i].im = 0;
- }
- }
- void IRAM_ATTR get_am(struct COMPLEX* input){
- for(int i=0;i<NUM_FFT_BUF/2;i++){
- input[i].re = input[i].im = sqrtf((input[i].re*input[i].re) + (input[i].im*input[i].im));
- input[i+NUM_FFT_BUF/2].re = input[i+NUM_FFT_BUF/2].im = 0;
- }
- }
- void IRAM_ATTR rx_dsp(void *pvParameters){
-
- while(true){
- #ifdef DEBUG_RUN
- int rx_time = micros();
- #endif
- xSemaphoreTake(xRXDSP, portMAX_DELAY);//ждем сигнала о готвности приемного буфера
- #ifdef DEBUG_RUN
- if (access_dsp_wait){rx_dsp_wait_result = micros()-rx_time;access_dsp_wait=false;}
- rx_time = micros();
- #endif
- init_filters (num_filter);
- if(rf_mode!= AM)
- {
- xtensa_cfft_f32(&cfft,(float*)&workbuf_in,0,1);
- get_ssb(pos_fft,(struct COMPLEX*)&workbuf_in);//демодуляция ssb участка спектра в позиции pos_fft
- smeter = S_metr_ssb((float*) &workbuf_in);
- xtensa_cfft_f32(&cfft,(float*)&workbuf_in,1,1);
- }
- else
- {
- get_am((struct COMPLEX*)&workbuf_in);//пока работает не должным образом
- }
- fir_f32(&fir_rx, (float*)&workbuf_in, (float*)&workbuf_out, NUM_FFT_BUF);//основной фильтр
- //разрешаем выводить звук и прием след.партии отсчетов
- #ifdef DEBUG_RUN
- if (access_dsp_run){rx_dsp_run_result = micros()-rx_time;access_dsp_run=false;}
- #endif
- if(current_mode == RX_MODE){xSemaphoreGive(xRXOUT);}
- if (smeter > old_smeter){old_smeter=smeter;}
- if(old_smeter>70)old_smeter=70;
- }
- }
- xSemaphoreHandle xTXDSP;
- xSemaphoreHandle xTXIN;
- xSemaphoreHandle xTXOUT;
- void IRAM_ATTR tx_in(void * pvParameters){
- size_t readsize = 0;
- while(true){
- xSemaphoreTake(xTXIN, portMAX_DELAY);//ждем сигнала об окончании dsp-обработки предыдущего буфера
- if(current_mode==TX_MODE)i2s_read(I2S_NUM_0, &input_buffer, sizeof(input_buffer), &readsize, portMAX_DELAY);
- for (int i=0; i<NUM_SAMPLE_BUF; i++) { //копируем все принятые отсчеты в рабочий буфер
- workbuf_re[i] = (float)(input_buffer[i].re>>12);
- workbuf_im[i] = (float)(input_buffer[i].im>>12);
- }
- if(current_mode==TX_MODE)xSemaphoreGive(xTXDSP);//разрешаем dsp-обработку рабочего буфера
- }
- }
- void IRAM_ATTR tx_out(void * pvParameters){
- size_t readsize = 0;
- while(true){
- xSemaphoreTake(xTXOUT, portMAX_DELAY); //ждем сигнала об окончании dsp-обработки выходного буфера
- for (int i=0; i<NUM_SAMPLE_BUF; i++) { //переносим обработанный массив в выходной буфер с нормализацией в I2S-формат
- output_buffer[i].re = ((int)(workbuf_re[i]))<<12;
- output_buffer[i].im = ((int)(workbuf_im[i]))<<12;
- }
- if(current_mode==TX_MODE)i2s_write(I2S_NUM_0, &output_buffer, sizeof(output_buffer), &readsize, portMAX_DELAY );//вывод звука
- }
- }
- void IRAM_ATTR tx_dsp(void *pvParameters){
- while(true){
- xSemaphoreTake(xTXDSP, portMAX_DELAY);//ждем готовности рабочего буфера
- switch(rf_mode){//формируем квадратуры (гилберт+фнч)
- case USB:
- fir_f32(&fir_90, (float*)&workbuf_re, (float*)&workbuf_re, NUM_SAMPLE_BUF);//Hilbert90
- fir_f32(&fir_00, (float*)&workbuf_im, (float*)&workbuf_im, NUM_SAMPLE_BUF);//Hilbert00
- break;
- case LSB:
- fir_f32(&fir_00, (float*)&workbuf_re, (float*)&workbuf_re, NUM_SAMPLE_BUF);//Hilbert00
- fir_f32(&fir_90, (float*)&workbuf_im, (float*)&workbuf_im, NUM_SAMPLE_BUF);//Hilbert90
- break;
- }
- if(current_mode==TX_MODE){
- xSemaphoreGive(xTXIN); //разрешаем прием следующей партии отсчетов
- xSemaphoreGive(xTXOUT); //разрешаем выводить квадратуры в смеситель
- }
- }
- }
这个编解码写的很清晰 |
|
IP卡
狗仔卡
发表于 2024-7-17 08:43:22
沉默卡
喧嚣卡
变色卡
显身卡
楼主
