mirror of https://github.com/PentHertz/srsLTE.git
Plot runs as thread in pdsch ue
This commit is contained in:
parent
2dfe82fb9c
commit
37e386d6d5
|
@ -35,11 +35,12 @@
|
||||||
#include <unistd.h>
|
#include <unistd.h>
|
||||||
#include <assert.h>
|
#include <assert.h>
|
||||||
#include <signal.h>
|
#include <signal.h>
|
||||||
|
#include <pthread.h>
|
||||||
|
#include <semaphore.h>
|
||||||
|
|
||||||
#include "liblte/rrc/rrc.h"
|
#include "liblte/rrc/rrc.h"
|
||||||
#include "liblte/phy/phy.h"
|
#include "liblte/phy/phy.h"
|
||||||
|
|
||||||
#include "liblte/graphics/plot/plot_waterfall.h"
|
|
||||||
|
|
||||||
#ifndef DISABLE_UHD
|
#ifndef DISABLE_UHD
|
||||||
#include "liblte/cuhd/cuhd.h"
|
#include "liblte/cuhd/cuhd.h"
|
||||||
|
@ -49,8 +50,11 @@
|
||||||
#define STDOUT_COMPACT
|
#define STDOUT_COMPACT
|
||||||
|
|
||||||
#ifndef DISABLE_GRAPHICS
|
#ifndef DISABLE_GRAPHICS
|
||||||
void init_plots(lte_cell_t cell);
|
#include "liblte/graphics/plot.h"
|
||||||
void do_plots(ue_dl_t *q, uint32_t sf_idx, ue_sync_t *qs);
|
void init_plots();
|
||||||
|
pthread_t plot_thread;
|
||||||
|
sem_t plot_sem;
|
||||||
|
uint32_t plot_sf_idx;
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
|
||||||
|
@ -207,17 +211,17 @@ extern float mean_exec_time;
|
||||||
|
|
||||||
enum receiver_state { DECODE_MIB, DECODE_PDSCH} state;
|
enum receiver_state { DECODE_MIB, DECODE_PDSCH} state;
|
||||||
|
|
||||||
|
ue_dl_t ue_dl;
|
||||||
|
ue_sync_t ue_sync;
|
||||||
|
prog_args_t prog_args;
|
||||||
|
|
||||||
int main(int argc, char **argv) {
|
int main(int argc, char **argv) {
|
||||||
int ret;
|
int ret;
|
||||||
cf_t *sf_buffer;
|
cf_t *sf_buffer;
|
||||||
prog_args_t prog_args;
|
|
||||||
lte_cell_t cell;
|
lte_cell_t cell;
|
||||||
int64_t sf_cnt;
|
int64_t sf_cnt;
|
||||||
ue_sync_t ue_sync;
|
|
||||||
ue_mib_t ue_mib;
|
ue_mib_t ue_mib;
|
||||||
void *uhd;
|
void *uhd;
|
||||||
ue_dl_t ue_dl;
|
|
||||||
uint32_t nof_trials = 0;
|
uint32_t nof_trials = 0;
|
||||||
uint32_t sfn = 0; // system frame number
|
uint32_t sfn = 0; // system frame number
|
||||||
int n;
|
int n;
|
||||||
|
@ -338,6 +342,7 @@ int main(int argc, char **argv) {
|
||||||
uint32_t nframes=0;
|
uint32_t nframes=0;
|
||||||
float rsrp=0.0, rsrq=0.0, snr=0.0;
|
float rsrp=0.0, rsrq=0.0, snr=0.0;
|
||||||
bool decode_pdsch;
|
bool decode_pdsch;
|
||||||
|
int pdcch_tx=0;
|
||||||
|
|
||||||
/* Main loop */
|
/* Main loop */
|
||||||
while (!go_exit && (sf_cnt < prog_args.nof_subframes || prog_args.nof_subframes == -1)) {
|
while (!go_exit && (sf_cnt < prog_args.nof_subframes || prog_args.nof_subframes == -1)) {
|
||||||
|
@ -412,12 +417,15 @@ int main(int argc, char **argv) {
|
||||||
rsrq = 0;
|
rsrq = 0;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
if (ue_sync_get_sfidx(&ue_sync) != 5 && ue_sync_get_sfidx(&ue_sync) != 0) {
|
||||||
|
pdcch_tx++;
|
||||||
|
}
|
||||||
|
|
||||||
// Plot and Printf
|
// Plot and Printf
|
||||||
if (ue_sync_get_sfidx(&ue_sync) == 5) {
|
if (ue_sync_get_sfidx(&ue_sync) == 5) {
|
||||||
#ifdef STDOUT_COMPACT
|
#ifdef STDOUT_COMPACT
|
||||||
printf("PDCCH-Miss: %5.2f%%, PDSCH-BLER: %5.2f%% (%d blocks)\r",
|
printf("SFN: %4d, PDCCH-Miss: %5.2f%% (%d), PDSCH-BLER: %5.2f%% (%d blocks)\r",
|
||||||
100*(1-(float) ue_dl.nof_pdcch_detected/nof_trials),
|
sfn, 100*(1-(float) ue_dl.nof_pdcch_detected/nof_trials),ue_dl.nof_pdcch_detected-pdcch_tx,
|
||||||
(float) 100*ue_dl.pkt_errors/ue_dl.pkts_total,nof_trials, ue_dl.pkts_total);
|
(float) 100*ue_dl.pkt_errors/ue_dl.pkts_total,nof_trials, ue_dl.pkts_total);
|
||||||
#else
|
#else
|
||||||
printf("CFO: %+8.4f KHz, SFO: %+8.4f Khz, "
|
printf("CFO: %+8.4f KHz, SFO: %+8.4f Khz, "
|
||||||
|
@ -441,7 +449,8 @@ int main(int argc, char **argv) {
|
||||||
}
|
}
|
||||||
#ifndef DISABLE_GRAPHICS
|
#ifndef DISABLE_GRAPHICS
|
||||||
if (!prog_args.disable_plots) {
|
if (!prog_args.disable_plots) {
|
||||||
do_plots(&ue_dl, ue_sync_get_sfidx(&ue_sync), !prog_args.input_file_name?&ue_sync:NULL);
|
plot_sf_idx = ue_sync_get_sfidx(&ue_sync);
|
||||||
|
sem_post(&plot_sem);
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
} else if (ret == 0) {
|
} else if (ret == 0) {
|
||||||
|
@ -479,7 +488,6 @@ int main(int argc, char **argv) {
|
||||||
#ifndef DISABLE_GRAPHICS
|
#ifndef DISABLE_GRAPHICS
|
||||||
|
|
||||||
|
|
||||||
#include "liblte/graphics/plot.h"
|
|
||||||
plot_waterfall_t poutfft;
|
plot_waterfall_t poutfft;
|
||||||
plot_real_t p_sync, pce;
|
plot_real_t p_sync, pce;
|
||||||
plot_scatter_t pscatequal, pscatequal_pdcch;
|
plot_scatter_t pscatequal, pscatequal_pdcch;
|
||||||
|
@ -488,10 +496,53 @@ float tmp_plot[SLOT_LEN_RE(MAX_PRB, CPNORM)];
|
||||||
float tmp_plot2[SLOT_LEN_RE(MAX_PRB, CPNORM)];
|
float tmp_plot2[SLOT_LEN_RE(MAX_PRB, CPNORM)];
|
||||||
float tmp_plot3[SLOT_LEN_RE(MAX_PRB, CPNORM)];
|
float tmp_plot3[SLOT_LEN_RE(MAX_PRB, CPNORM)];
|
||||||
|
|
||||||
void init_plots(lte_cell_t cell) {
|
void *plot_thread_run(void *arg) {
|
||||||
|
int i;
|
||||||
|
uint32_t nof_re = SF_LEN_RE(ue_dl.cell.nof_prb, ue_dl.cell.cp);
|
||||||
|
|
||||||
|
while(1) {
|
||||||
|
sem_wait(&plot_sem);
|
||||||
|
|
||||||
|
uint32_t nof_symbols = ue_dl.harq_process[0].prb_alloc.re_sf[plot_sf_idx];
|
||||||
|
for (i = 0; i < nof_re; i++) {
|
||||||
|
tmp_plot[i] = 20 * log10f(cabsf(ue_dl.sf_symbols[i]));
|
||||||
|
if (isinf(tmp_plot[i])) {
|
||||||
|
tmp_plot[i] = -80;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
for (i = 0; i < REFSIGNAL_NUM_SF(ue_dl.cell.nof_prb,0); i++) {
|
||||||
|
tmp_plot2[i] = 20 * log10f(cabsf(ue_dl.chest.pilot_estimates_average[0][i]));
|
||||||
|
if (isinf(tmp_plot2[i])) {
|
||||||
|
tmp_plot2[i] = -80;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
for (i=0;i<CP_NSYMB(ue_dl.cell.cp);i++) {
|
||||||
|
plot_waterfall_appendNewData(&poutfft, &tmp_plot[i*RE_X_RB*ue_dl.cell.nof_prb], RE_X_RB*ue_dl.cell.nof_prb);
|
||||||
|
}
|
||||||
|
plot_real_setNewData(&pce, tmp_plot2, REFSIGNAL_NUM_SF(ue_dl.cell.nof_prb,0));
|
||||||
|
if (!prog_args.input_file_name) {
|
||||||
|
int max = vec_max_fi(ue_sync.strack.pss.conv_output_avg, ue_sync.strack.pss.frame_size+ue_sync.strack.pss.fft_size-1);
|
||||||
|
vec_sc_prod_fff(ue_sync.strack.pss.conv_output_avg,
|
||||||
|
1/ue_sync.strack.pss.conv_output_avg[max],
|
||||||
|
tmp_plot2,
|
||||||
|
ue_sync.strack.pss.frame_size+ue_sync.strack.pss.fft_size-1);
|
||||||
|
plot_real_setNewData(&p_sync, tmp_plot2, ue_sync.strack.pss.frame_size);
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
plot_scatter_setNewData(&pscatequal, ue_dl.pdsch.pdsch_d, nof_symbols);
|
||||||
|
plot_scatter_setNewData(&pscatequal_pdcch, ue_dl.pdcch.pdcch_d, 36*ue_dl.pdcch.nof_cce);
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
void init_plots() {
|
||||||
|
|
||||||
plot_init();
|
plot_init();
|
||||||
|
|
||||||
plot_waterfall_init(&poutfft, RE_X_RB * cell.nof_prb, 5000);
|
plot_waterfall_init(&poutfft, RE_X_RB * ue_dl.cell.nof_prb, 1000);
|
||||||
plot_waterfall_setTitle(&poutfft, "Output FFT - Magnitude");
|
plot_waterfall_setTitle(&poutfft, "Output FFT - Magnitude");
|
||||||
plot_waterfall_setPlotYAxisScale(&poutfft, -40, 40);
|
plot_waterfall_setPlotYAxisScale(&poutfft, -40, 40);
|
||||||
|
|
||||||
|
@ -514,40 +565,15 @@ void init_plots(lte_cell_t cell) {
|
||||||
plot_scatter_setXAxisScale(&pscatequal_pdcch, -4, 4);
|
plot_scatter_setXAxisScale(&pscatequal_pdcch, -4, 4);
|
||||||
plot_scatter_setYAxisScale(&pscatequal_pdcch, -4, 4);
|
plot_scatter_setYAxisScale(&pscatequal_pdcch, -4, 4);
|
||||||
|
|
||||||
|
if (sem_init(&plot_sem, 0, 0)) {
|
||||||
|
perror("sem_init");
|
||||||
|
exit(-1);
|
||||||
}
|
}
|
||||||
|
|
||||||
void do_plots(ue_dl_t *q, uint32_t sf_idx, ue_sync_t *qs) {
|
if (pthread_create(&plot_thread, NULL, plot_thread_run, NULL)) {
|
||||||
int i;
|
perror("pthread_create");
|
||||||
uint32_t nof_re = SF_LEN_RE(q->cell.nof_prb, q->cell.cp);
|
exit(-1);
|
||||||
uint32_t nof_symbols = q->harq_process[0].prb_alloc.re_sf[sf_idx];
|
|
||||||
for (i = 0; i < nof_re; i++) {
|
|
||||||
tmp_plot[i] = 20 * log10f(cabsf(q->sf_symbols[i]));
|
|
||||||
if (isinf(tmp_plot[i])) {
|
|
||||||
tmp_plot[i] = -80;
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
for (i = 0; i < REFSIGNAL_NUM_SF(q->cell.nof_prb,0); i++) {
|
|
||||||
tmp_plot2[i] = 20 * log10f(cabsf(q->chest.pilot_estimates_average[0][i]));
|
|
||||||
if (isinf(tmp_plot2[i])) {
|
|
||||||
tmp_plot2[i] = -80;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
for (i=0;i<CP_NSYMB(q->cell.cp);i++) {
|
|
||||||
plot_waterfall_appendNewData(&poutfft, &tmp_plot[i*RE_X_RB*q->cell.nof_prb], RE_X_RB*q->cell.nof_prb);
|
|
||||||
}
|
|
||||||
plot_real_setNewData(&pce, tmp_plot2, REFSIGNAL_NUM_SF(q->cell.nof_prb,0));
|
|
||||||
if (qs) {
|
|
||||||
int max = vec_max_fi(qs->strack.pss.conv_output_avg, qs->strack.pss.frame_size+qs->strack.pss.fft_size-1);
|
|
||||||
vec_sc_prod_fff(qs->strack.pss.conv_output_avg,
|
|
||||||
1/qs->strack.pss.conv_output_avg[max],
|
|
||||||
tmp_plot2,
|
|
||||||
qs->strack.pss.frame_size+qs->strack.pss.fft_size-1);
|
|
||||||
plot_real_setNewData(&p_sync, tmp_plot2, qs->strack.pss.frame_size);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
plot_scatter_setNewData(&pscatequal, q->pdsch.pdsch_d, nof_symbols);
|
|
||||||
plot_scatter_setNewData(&pscatequal_pdcch, q->pdcch.pdcch_d, 36*q->pdcch.nof_cce);
|
|
||||||
}
|
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
|
@ -359,7 +359,6 @@ int ue_sync_get_buffer(ue_sync_t *q, cf_t **sf_symbols) {
|
||||||
{
|
{
|
||||||
|
|
||||||
if (q->file_mode) {
|
if (q->file_mode) {
|
||||||
usleep(1000);
|
|
||||||
int n = filesource_read(&q->file_source, q->input_buffer, q->sf_len);
|
int n = filesource_read(&q->file_source, q->input_buffer, q->sf_len);
|
||||||
if (n < 0) {
|
if (n < 0) {
|
||||||
fprintf(stderr, "Error reading input file\n");
|
fprintf(stderr, "Error reading input file\n");
|
||||||
|
|
Loading…
Reference in New Issue