2020-11-26 01:25:22 -08:00
|
|
|
/**
|
2020-10-20 02:59:59 -07:00
|
|
|
*
|
2020-11-26 01:25:22 -08:00
|
|
|
* \section COPYRIGHT
|
2020-10-20 02:59:59 -07:00
|
|
|
*
|
2020-11-26 01:25:22 -08:00
|
|
|
* Copyright 2013-2020 Software Radio Systems Limited
|
2020-10-20 02:59:59 -07:00
|
|
|
*
|
2020-11-26 01:25:22 -08:00
|
|
|
* By using this file, you agree to the terms and conditions set
|
|
|
|
* forth in the LICENSE file which can be found at the top level of
|
|
|
|
* the distribution.
|
2020-10-20 02:59:59 -07:00
|
|
|
*
|
|
|
|
*/
|
|
|
|
#include "srslte/phy/phch/pdsch_nr.h"
|
2020-11-10 11:04:12 -08:00
|
|
|
#include "srslte/phy/common/phy_common_nr.h"
|
2020-11-11 03:43:18 -08:00
|
|
|
#include "srslte/phy/phch/ra_nr.h"
|
2020-11-10 11:04:12 -08:00
|
|
|
|
2020-11-11 07:13:25 -08:00
|
|
|
int pdsch_nr_init_common(srslte_pdsch_nr_t* q, const srslte_pdsch_args_t* args)
|
2020-11-10 11:04:12 -08:00
|
|
|
{
|
|
|
|
for (srslte_mod_t mod = SRSLTE_MOD_BPSK; mod < SRSLTE_MOD_NITEMS; mod++) {
|
|
|
|
if (srslte_modem_table_lte(&q->modem_tables[mod], mod) < SRSLTE_SUCCESS) {
|
|
|
|
ERROR("Error initialising modem table for %s\n", srslte_mod_string(mod));
|
|
|
|
return SRSLTE_ERROR;
|
|
|
|
}
|
2020-11-11 07:13:25 -08:00
|
|
|
if (args->measure_evm) {
|
|
|
|
srslte_modem_table_bytes(&q->modem_tables[mod]);
|
|
|
|
}
|
2020-11-10 11:04:12 -08:00
|
|
|
}
|
|
|
|
|
|
|
|
return SRSLTE_SUCCESS;
|
|
|
|
}
|
|
|
|
|
2020-11-11 09:50:41 -08:00
|
|
|
int srslte_pdsch_nr_init_enb(srslte_pdsch_nr_t* q, const srslte_pdsch_args_t* args)
|
2020-11-10 11:04:12 -08:00
|
|
|
{
|
|
|
|
if (q == NULL) {
|
|
|
|
return SRSLTE_ERROR_INVALID_INPUTS;
|
|
|
|
}
|
|
|
|
|
2020-11-11 07:13:25 -08:00
|
|
|
if (pdsch_nr_init_common(q, args) < SRSLTE_SUCCESS) {
|
2020-11-10 11:04:12 -08:00
|
|
|
return SRSLTE_ERROR;
|
|
|
|
}
|
|
|
|
|
2020-11-11 07:13:25 -08:00
|
|
|
if (srslte_sch_nr_init_tx(&q->sch, &args->sch)) {
|
2020-11-10 11:04:12 -08:00
|
|
|
ERROR("Initialising SCH\n");
|
|
|
|
return SRSLTE_ERROR;
|
|
|
|
}
|
|
|
|
|
|
|
|
return SRSLTE_SUCCESS;
|
|
|
|
}
|
|
|
|
|
2020-11-11 09:50:41 -08:00
|
|
|
int srslte_pdsch_nr_init_ue(srslte_pdsch_nr_t* q, const srslte_pdsch_args_t* args)
|
2020-11-10 11:04:12 -08:00
|
|
|
{
|
2020-11-11 07:13:25 -08:00
|
|
|
if (q == NULL || args == NULL) {
|
2020-11-10 11:04:12 -08:00
|
|
|
return SRSLTE_ERROR_INVALID_INPUTS;
|
|
|
|
}
|
|
|
|
|
2020-11-11 07:13:25 -08:00
|
|
|
if (pdsch_nr_init_common(q, args) < SRSLTE_SUCCESS) {
|
2020-11-10 11:04:12 -08:00
|
|
|
return SRSLTE_ERROR;
|
|
|
|
}
|
|
|
|
|
2020-11-11 07:13:25 -08:00
|
|
|
if (srslte_sch_nr_init_rx(&q->sch, &args->sch)) {
|
2020-11-10 11:04:12 -08:00
|
|
|
ERROR("Initialising SCH\n");
|
|
|
|
return SRSLTE_ERROR;
|
|
|
|
}
|
|
|
|
|
2020-11-11 07:13:25 -08:00
|
|
|
if (args->measure_evm) {
|
|
|
|
q->evm_buffer = srslte_evm_buffer_alloc(8);
|
|
|
|
if (q->evm_buffer == NULL) {
|
|
|
|
ERROR("Initialising EVM\n");
|
|
|
|
return SRSLTE_ERROR;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2020-11-20 03:12:29 -08:00
|
|
|
q->meas_time_en = args->measure_time;
|
|
|
|
|
2020-11-10 11:04:12 -08:00
|
|
|
return SRSLTE_SUCCESS;
|
|
|
|
}
|
|
|
|
|
2020-11-17 08:02:14 -08:00
|
|
|
int srslte_pdsch_nr_set_carrier(srslte_pdsch_nr_t* q, const srslte_carrier_nr_t* carrier)
|
2020-11-10 11:04:12 -08:00
|
|
|
{
|
|
|
|
// Set carrier
|
|
|
|
q->carrier = *carrier;
|
|
|
|
|
|
|
|
// Reallocate symbols if necessary
|
2020-11-17 08:02:14 -08:00
|
|
|
if (q->max_layers < carrier->max_mimo_layers || q->max_prb < carrier->nof_prb) {
|
|
|
|
q->max_layers = carrier->max_mimo_layers;
|
2020-11-10 11:04:12 -08:00
|
|
|
q->max_prb = carrier->nof_prb;
|
|
|
|
|
|
|
|
// Free current allocations
|
|
|
|
for (uint32_t i = 0; i < SRSLTE_MAX_LAYERS_NR; i++) {
|
|
|
|
if (q->x[i] != NULL) {
|
|
|
|
free(q->x[i]);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
// Allocate for new sizes
|
|
|
|
for (uint32_t i = 0; i < q->max_layers; i++) {
|
|
|
|
q->x[i] = srslte_vec_cf_malloc(SRSLTE_SLOT_LEN_RE_NR(q->max_prb));
|
|
|
|
if (q->x[i] == NULL) {
|
|
|
|
ERROR("Malloc");
|
|
|
|
return SRSLTE_ERROR;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
// Allocate code words according to table 7.3.1.3-1
|
|
|
|
uint32_t max_cw = (q->max_layers > 5) ? 2 : 1;
|
|
|
|
if (q->max_cw < max_cw) {
|
|
|
|
q->max_cw = max_cw;
|
|
|
|
|
|
|
|
for (uint32_t i = 0; i < max_cw; i++) {
|
|
|
|
if (q->b[i] == NULL) {
|
2020-11-12 03:48:00 -08:00
|
|
|
q->b[i] = srslte_vec_u8_malloc(SRSLTE_SLOT_MAX_NOF_BITS_NR);
|
2020-11-10 11:04:12 -08:00
|
|
|
if (q->b[i] == NULL) {
|
|
|
|
ERROR("Malloc");
|
|
|
|
return SRSLTE_ERROR;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (q->d[i] == NULL) {
|
|
|
|
q->d[i] = srslte_vec_cf_malloc(SRSLTE_SLOT_MAX_LEN_RE_NR);
|
|
|
|
if (q->d[i] == NULL) {
|
|
|
|
ERROR("Malloc");
|
|
|
|
return SRSLTE_ERROR;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
// Set carrier in SCH
|
|
|
|
if (srslte_sch_nr_set_carrier(&q->sch, carrier) < SRSLTE_SUCCESS) {
|
|
|
|
return SRSLTE_ERROR;
|
|
|
|
}
|
|
|
|
|
2020-11-11 07:13:25 -08:00
|
|
|
if (q->evm_buffer != NULL) {
|
|
|
|
srslte_evm_buffer_resize(q->evm_buffer, SRSLTE_SLOT_LEN_RE_NR(q->max_prb) * SRSLTE_MAX_QM);
|
|
|
|
}
|
|
|
|
|
2020-11-10 11:04:12 -08:00
|
|
|
return SRSLTE_SUCCESS;
|
|
|
|
}
|
|
|
|
|
|
|
|
void srslte_pdsch_nr_free(srslte_pdsch_nr_t* q)
|
|
|
|
{
|
|
|
|
if (q == NULL) {
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
for (uint32_t cw = 0; cw < SRSLTE_MAX_CODEWORDS; cw++) {
|
|
|
|
if (q->b[cw]) {
|
|
|
|
free(q->b[cw]);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (q->d[cw]) {
|
|
|
|
free(q->d[cw]);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
srslte_sch_nr_free(&q->sch);
|
|
|
|
|
|
|
|
for (uint32_t i = 0; i < SRSLTE_MAX_LAYERS_NR; i++) {
|
|
|
|
if (q->x[i]) {
|
|
|
|
free(q->x[i]);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
for (srslte_mod_t mod = SRSLTE_MOD_BPSK; mod < SRSLTE_MOD_NITEMS; mod++) {
|
|
|
|
srslte_modem_table_free(&q->modem_tables[mod]);
|
|
|
|
}
|
2020-11-11 07:13:25 -08:00
|
|
|
|
|
|
|
if (q->evm_buffer != NULL) {
|
|
|
|
srslte_evm_free(q->evm_buffer);
|
|
|
|
}
|
2020-11-10 11:04:12 -08:00
|
|
|
}
|
2020-10-20 02:59:59 -07:00
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief copies a number of countiguous Resource Elements
|
|
|
|
* @param sf_symbols slot symbols in frequency domain
|
|
|
|
* @param symbols resource elements
|
|
|
|
* @param count number of resource elements to copy
|
|
|
|
* @param put Direction, symbols are copied into sf_symbols if put is true, otherwise sf_symbols are copied into symbols
|
|
|
|
*/
|
|
|
|
static void srslte_pdsch_re_cp(cf_t* sf_symbols, cf_t* symbols, uint32_t count, bool put)
|
|
|
|
{
|
|
|
|
if (put) {
|
|
|
|
srslte_vec_cf_copy(sf_symbols, symbols, count);
|
|
|
|
} else {
|
|
|
|
srslte_vec_cf_copy(symbols, sf_symbols, count);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2020-11-03 07:06:47 -08:00
|
|
|
static uint32_t srslte_pdsch_nr_cp_dmrs_type1(const srslte_pdsch_nr_t* q,
|
|
|
|
const srslte_pdsch_grant_nr_t* grant,
|
|
|
|
cf_t* symbols,
|
|
|
|
cf_t* sf_symbols,
|
|
|
|
bool put)
|
2020-10-20 02:59:59 -07:00
|
|
|
{
|
|
|
|
uint32_t count = 0;
|
|
|
|
uint32_t delta = 0;
|
|
|
|
|
|
|
|
for (uint32_t i = 0; i < q->carrier.nof_prb; i++) {
|
2020-11-03 07:06:47 -08:00
|
|
|
if (grant->prb_idx[i]) {
|
2020-10-20 02:59:59 -07:00
|
|
|
for (uint32_t j = 0; j < SRSLTE_NRE; j += 2) {
|
|
|
|
if (put) {
|
2020-11-12 03:48:00 -08:00
|
|
|
sf_symbols[i * SRSLTE_NRE + delta + j + 1] = symbols[count++];
|
2020-10-20 02:59:59 -07:00
|
|
|
} else {
|
2020-11-12 03:48:00 -08:00
|
|
|
symbols[count++] = sf_symbols[i * SRSLTE_NRE + delta + j + 1];
|
2020-10-20 02:59:59 -07:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
2020-11-03 07:06:47 -08:00
|
|
|
static uint32_t srslte_pdsch_nr_cp_dmrs_type2(const srslte_pdsch_nr_t* q,
|
|
|
|
const srslte_pdsch_grant_nr_t* grant,
|
|
|
|
cf_t* symbols,
|
|
|
|
cf_t* sf_symbols,
|
|
|
|
bool put)
|
2020-10-20 02:59:59 -07:00
|
|
|
{
|
|
|
|
uint32_t count = 0;
|
|
|
|
uint32_t delta = 0;
|
|
|
|
|
|
|
|
for (uint32_t i = 0; i < q->carrier.nof_prb; i++) {
|
2020-11-03 07:06:47 -08:00
|
|
|
if (grant->prb_idx[i]) {
|
2020-10-20 02:59:59 -07:00
|
|
|
// Copy RE before first pilot pair
|
|
|
|
if (delta > 0) {
|
|
|
|
srslte_pdsch_re_cp(&sf_symbols[i * SRSLTE_NRE], &symbols[count], delta, put);
|
|
|
|
count += delta;
|
|
|
|
}
|
|
|
|
|
|
|
|
// Copy RE between pilot pairs
|
|
|
|
srslte_pdsch_re_cp(&sf_symbols[i * SRSLTE_NRE + delta + 2], &symbols[count], 4, put);
|
|
|
|
count += 4;
|
|
|
|
|
|
|
|
// Copy RE after second pilot
|
|
|
|
srslte_pdsch_re_cp(&sf_symbols[(i + 1) * SRSLTE_NRE - 4 + delta], &symbols[count], 4 - delta, put);
|
|
|
|
count += 4 - delta;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
2020-11-03 07:06:47 -08:00
|
|
|
static uint32_t srslte_pdsch_nr_cp_dmrs(const srslte_pdsch_nr_t* q,
|
|
|
|
const srslte_pdsch_cfg_nr_t* cfg,
|
|
|
|
const srslte_pdsch_grant_nr_t* grant,
|
|
|
|
cf_t* symbols,
|
|
|
|
cf_t* sf_symbols,
|
|
|
|
bool put)
|
2020-10-20 02:59:59 -07:00
|
|
|
{
|
|
|
|
uint32_t count = 0;
|
|
|
|
|
2020-11-03 07:06:47 -08:00
|
|
|
const srslte_pdsch_dmrs_cfg_t* dmrs_cfg =
|
|
|
|
grant->mapping == srslte_pdsch_mapping_type_A ? &cfg->dmrs_cfg_typeA : &cfg->dmrs_cfg_typeB;
|
|
|
|
|
|
|
|
switch (dmrs_cfg->type) {
|
2020-10-20 02:59:59 -07:00
|
|
|
case srslte_dmrs_pdsch_type_1:
|
2020-11-03 07:06:47 -08:00
|
|
|
count = srslte_pdsch_nr_cp_dmrs_type1(q, grant, symbols, sf_symbols, put);
|
2020-10-20 02:59:59 -07:00
|
|
|
break;
|
|
|
|
case srslte_dmrs_pdsch_type_2:
|
2020-11-03 07:06:47 -08:00
|
|
|
count = srslte_pdsch_nr_cp_dmrs_type2(q, grant, symbols, sf_symbols, put);
|
2020-10-20 02:59:59 -07:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
2020-11-03 07:06:47 -08:00
|
|
|
static uint32_t srslte_pdsch_nr_cp_clean(const srslte_pdsch_nr_t* q,
|
|
|
|
const srslte_pdsch_grant_nr_t* grant,
|
|
|
|
cf_t* symbols,
|
|
|
|
cf_t* sf_symbols,
|
|
|
|
bool put)
|
2020-10-20 02:59:59 -07:00
|
|
|
{
|
|
|
|
uint32_t count = 0;
|
|
|
|
uint32_t start = 0; // Index of the start of continuous data
|
|
|
|
uint32_t length = 0; // End of continuous RE
|
|
|
|
|
|
|
|
for (uint32_t i = 0; i < q->carrier.nof_prb; i++) {
|
2020-11-03 07:06:47 -08:00
|
|
|
if (grant->prb_idx[i]) {
|
2020-10-20 02:59:59 -07:00
|
|
|
// If fist continuous block, save start
|
|
|
|
if (length == 0) {
|
|
|
|
start = i * SRSLTE_NRE;
|
|
|
|
}
|
|
|
|
length += SRSLTE_NRE;
|
|
|
|
} else {
|
|
|
|
// Consecutive block is finished
|
|
|
|
if (put) {
|
|
|
|
srslte_vec_cf_copy(&sf_symbols[start], &symbols[count], length);
|
|
|
|
} else {
|
|
|
|
srslte_vec_cf_copy(&symbols[count], &sf_symbols[start], length);
|
|
|
|
}
|
|
|
|
|
|
|
|
// Increase RE count
|
|
|
|
count += length;
|
|
|
|
|
|
|
|
// Reset consecutive block
|
|
|
|
length = 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
// Copy last contiguous block
|
|
|
|
if (length > 0) {
|
|
|
|
if (put) {
|
|
|
|
srslte_vec_cf_copy(&sf_symbols[start], &symbols[count], length);
|
|
|
|
} else {
|
|
|
|
srslte_vec_cf_copy(&symbols[count], &sf_symbols[start], length);
|
|
|
|
}
|
|
|
|
count += length;
|
|
|
|
}
|
|
|
|
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
2020-11-03 07:06:47 -08:00
|
|
|
static int srslte_pdsch_nr_cp(const srslte_pdsch_nr_t* q,
|
|
|
|
const srslte_pdsch_cfg_nr_t* cfg,
|
|
|
|
const srslte_pdsch_grant_nr_t* grant,
|
|
|
|
cf_t* symbols,
|
|
|
|
cf_t* sf_symbols,
|
|
|
|
bool put)
|
2020-10-20 02:59:59 -07:00
|
|
|
{
|
|
|
|
uint32_t count = 0;
|
|
|
|
uint32_t dmrs_l_idx[SRSLTE_DMRS_PDSCH_MAX_SYMBOLS] = {};
|
|
|
|
uint32_t dmrs_l_count = 0;
|
|
|
|
|
|
|
|
// Get symbol indexes carrying DMRS
|
2020-11-03 07:06:47 -08:00
|
|
|
int32_t nof_dmrs_symbols = srslte_dmrs_pdsch_get_symbols_idx(cfg, grant, dmrs_l_idx);
|
2020-10-20 02:59:59 -07:00
|
|
|
if (nof_dmrs_symbols < SRSLTE_SUCCESS) {
|
|
|
|
return SRSLTE_ERROR;
|
|
|
|
}
|
|
|
|
|
2020-11-11 03:43:18 -08:00
|
|
|
if (SRSLTE_DEBUG_ENABLED && srslte_verbose >= SRSLTE_VERBOSE_INFO && !handler_registered) {
|
|
|
|
printf("dmrs_l_idx=");
|
|
|
|
srslte_vec_fprint_i(stdout, (int32_t*)dmrs_l_idx, nof_dmrs_symbols);
|
|
|
|
}
|
|
|
|
|
|
|
|
for (uint32_t l = grant->S; l < grant->S + grant->L; l++) {
|
2020-10-20 02:59:59 -07:00
|
|
|
// Advance DMRS symbol counter until:
|
|
|
|
// - the current DMRS symbol index is greater or equal than current symbol l
|
|
|
|
// - no more DMRS symbols
|
|
|
|
while (dmrs_l_idx[dmrs_l_count] < l && dmrs_l_count < nof_dmrs_symbols) {
|
|
|
|
dmrs_l_count++;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (l == dmrs_l_idx[dmrs_l_count]) {
|
2020-11-03 07:06:47 -08:00
|
|
|
count += srslte_pdsch_nr_cp_dmrs(
|
|
|
|
q, cfg, grant, &symbols[count], &sf_symbols[l * q->carrier.nof_prb * SRSLTE_NRE], put);
|
2020-10-20 02:59:59 -07:00
|
|
|
} else {
|
2020-11-03 07:06:47 -08:00
|
|
|
count +=
|
|
|
|
srslte_pdsch_nr_cp_clean(q, grant, &symbols[count], &sf_symbols[l * q->carrier.nof_prb * SRSLTE_NRE], put);
|
2020-10-20 02:59:59 -07:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
2020-11-10 11:04:12 -08:00
|
|
|
static int srslte_pdsch_nr_put(const srslte_pdsch_nr_t* q,
|
|
|
|
const srslte_pdsch_cfg_nr_t* cfg,
|
|
|
|
const srslte_pdsch_grant_nr_t* grant,
|
|
|
|
cf_t* symbols,
|
|
|
|
cf_t* sf_symbols)
|
2020-10-20 02:59:59 -07:00
|
|
|
{
|
2020-11-03 07:06:47 -08:00
|
|
|
return srslte_pdsch_nr_cp(q, cfg, grant, symbols, sf_symbols, true);
|
2020-10-20 02:59:59 -07:00
|
|
|
}
|
|
|
|
|
2020-11-10 11:04:12 -08:00
|
|
|
static int srslte_pdsch_nr_get(const srslte_pdsch_nr_t* q,
|
|
|
|
const srslte_pdsch_cfg_nr_t* cfg,
|
|
|
|
const srslte_pdsch_grant_nr_t* grant,
|
|
|
|
cf_t* symbols,
|
|
|
|
cf_t* sf_symbols)
|
|
|
|
{
|
|
|
|
return srslte_pdsch_nr_cp(q, cfg, grant, symbols, sf_symbols, false);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline int pdsch_nr_encode_codeword(srslte_pdsch_nr_t* q,
|
|
|
|
const srslte_pdsch_cfg_nr_t* cfg,
|
|
|
|
const srslte_sch_tb_t* tb,
|
|
|
|
const uint8_t* data,
|
|
|
|
uint16_t rnti)
|
|
|
|
{
|
|
|
|
// Early return if TB is not enabled
|
|
|
|
if (!tb->enabled) {
|
|
|
|
return SRSLTE_SUCCESS;
|
|
|
|
}
|
|
|
|
|
|
|
|
// Check codeword index
|
|
|
|
if (tb->cw_idx >= q->max_cw) {
|
|
|
|
ERROR("Unsupported codeword index %d\n", tb->cw_idx);
|
|
|
|
return SRSLTE_ERROR;
|
|
|
|
}
|
|
|
|
|
|
|
|
// Check modulation
|
|
|
|
if (tb->mod >= SRSLTE_MOD_NITEMS) {
|
|
|
|
ERROR("Invalid modulation %s\n", srslte_mod_string(tb->mod));
|
|
|
|
return SRSLTE_ERROR_OUT_OF_BOUNDS;
|
|
|
|
}
|
|
|
|
|
|
|
|
// Encode SCH
|
|
|
|
if (srslte_dlsch_nr_encode(&q->sch, &cfg->sch_cfg, tb, data, q->b[tb->cw_idx]) < SRSLTE_SUCCESS) {
|
|
|
|
ERROR("Error in DL-SCH encoding\n");
|
|
|
|
return SRSLTE_ERROR;
|
|
|
|
}
|
|
|
|
|
2020-11-11 03:43:18 -08:00
|
|
|
if (SRSLTE_DEBUG_ENABLED && srslte_verbose >= SRSLTE_VERBOSE_INFO && !handler_registered) {
|
|
|
|
printf("b=");
|
|
|
|
srslte_vec_fprint_b(stdout, q->b[tb->cw_idx], tb->nof_bits);
|
|
|
|
}
|
|
|
|
|
2020-11-10 11:04:12 -08:00
|
|
|
// 7.3.1.1 Scrambling
|
|
|
|
uint32_t n_id = q->carrier.id;
|
|
|
|
if (cfg->scrambling_id_present && SRSLTE_RNTI_ISUSER(rnti)) {
|
|
|
|
n_id = cfg->scambling_id;
|
|
|
|
}
|
|
|
|
uint32_t cinit = ((uint32_t)rnti << 15U) + (tb->cw_idx << 14U) + n_id;
|
|
|
|
srslte_sequence_apply_bit(q->b[tb->cw_idx], q->b[tb->cw_idx], tb->nof_bits, cinit);
|
|
|
|
|
|
|
|
// 7.3.1.2 Modulation
|
|
|
|
srslte_mod_modulate(&q->modem_tables[tb->mod], q->b[tb->cw_idx], q->d[tb->cw_idx], tb->nof_bits);
|
|
|
|
|
2020-11-11 03:43:18 -08:00
|
|
|
if (SRSLTE_DEBUG_ENABLED && srslte_verbose >= SRSLTE_VERBOSE_INFO && !handler_registered) {
|
|
|
|
printf("d=");
|
|
|
|
srslte_vec_fprint_c(stdout, q->d[tb->cw_idx], tb->nof_re);
|
|
|
|
}
|
|
|
|
|
2020-11-10 11:04:12 -08:00
|
|
|
return SRSLTE_SUCCESS;
|
|
|
|
}
|
|
|
|
|
|
|
|
int srslte_pdsch_nr_encode(srslte_pdsch_nr_t* q,
|
|
|
|
const srslte_pdsch_cfg_nr_t* cfg,
|
|
|
|
const srslte_pdsch_grant_nr_t* grant,
|
|
|
|
uint8_t* data[SRSLTE_MAX_TB],
|
|
|
|
cf_t* sf_symbols[SRSLTE_MAX_PORTS])
|
|
|
|
{
|
|
|
|
|
|
|
|
// Check input pointers
|
|
|
|
if (!q || !cfg || !grant || !data || !sf_symbols) {
|
|
|
|
return SRSLTE_ERROR_INVALID_INPUTS;
|
|
|
|
}
|
|
|
|
|
2020-11-20 03:12:29 -08:00
|
|
|
struct timeval t[3];
|
|
|
|
if (q->meas_time_en) {
|
|
|
|
gettimeofday(&t[1], NULL);
|
|
|
|
}
|
|
|
|
|
2020-11-10 11:04:12 -08:00
|
|
|
// Check number of layers
|
|
|
|
if (q->max_layers < grant->nof_layers) {
|
|
|
|
ERROR("Error number of layers (%d) exceeds configured maximum (%d)\n", grant->nof_layers, q->max_layers);
|
|
|
|
return SRSLTE_ERROR;
|
|
|
|
}
|
|
|
|
|
|
|
|
// 7.3.1.1 and 7.3.1.2
|
2020-11-20 03:12:29 -08:00
|
|
|
uint32_t nof_cw = 0;
|
2020-11-10 11:04:12 -08:00
|
|
|
for (uint32_t tb = 0; tb < SRSLTE_MAX_TB; tb++) {
|
|
|
|
nof_cw += grant->tb[tb].enabled ? 1 : 0;
|
|
|
|
|
|
|
|
if (pdsch_nr_encode_codeword(q, cfg, &grant->tb[tb], data[tb], grant->rnti) < SRSLTE_SUCCESS) {
|
|
|
|
ERROR("Error encoding TB %d\n", tb);
|
|
|
|
return SRSLTE_ERROR;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
// 7.3.1.3 Layer mapping
|
|
|
|
cf_t** x = q->d;
|
|
|
|
if (grant->nof_layers > 1) {
|
|
|
|
x = q->x;
|
|
|
|
srslte_layermap_nr(q->d, nof_cw, x, grant->nof_layers, grant->nof_layers);
|
|
|
|
}
|
|
|
|
|
|
|
|
// 7.3.1.4 Antenna port mapping
|
|
|
|
// ... Not implemented
|
|
|
|
|
|
|
|
// 7.3.1.5 Mapping to virtual resource blocks
|
|
|
|
// ... Not implemented
|
|
|
|
|
|
|
|
// 7.3.1.6 Mapping from virtual to physical resource blocks
|
|
|
|
srslte_pdsch_nr_put(q, cfg, grant, x[0], sf_symbols[0]);
|
|
|
|
|
2020-11-20 03:12:29 -08:00
|
|
|
if (q->meas_time_en) {
|
|
|
|
gettimeofday(&t[2], NULL);
|
|
|
|
get_time_interval(t);
|
|
|
|
q->meas_time_us = (uint32_t)t[0].tv_usec;
|
|
|
|
}
|
|
|
|
|
2020-11-10 11:04:12 -08:00
|
|
|
return SRSLTE_SUCCESS;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline int pdsch_nr_decode_codeword(srslte_pdsch_nr_t* q,
|
|
|
|
const srslte_pdsch_cfg_nr_t* cfg,
|
|
|
|
const srslte_sch_tb_t* tb,
|
|
|
|
srslte_pdsch_res_nr_t* res,
|
|
|
|
uint16_t rnti)
|
2020-10-20 03:00:37 -07:00
|
|
|
{
|
2020-11-10 11:04:12 -08:00
|
|
|
// Early return if TB is not enabled
|
|
|
|
if (!tb->enabled) {
|
|
|
|
return SRSLTE_SUCCESS;
|
|
|
|
}
|
|
|
|
|
|
|
|
// Check codeword index
|
|
|
|
if (tb->cw_idx >= q->max_cw) {
|
|
|
|
ERROR("Unsupported codeword index %d\n", tb->cw_idx);
|
|
|
|
return SRSLTE_ERROR;
|
|
|
|
}
|
|
|
|
|
|
|
|
// Check modulation
|
|
|
|
if (tb->mod >= SRSLTE_MOD_NITEMS) {
|
|
|
|
ERROR("Invalid modulation %s\n", srslte_mod_string(tb->mod));
|
|
|
|
return SRSLTE_ERROR_OUT_OF_BOUNDS;
|
|
|
|
}
|
|
|
|
|
2020-11-11 03:43:18 -08:00
|
|
|
if (SRSLTE_DEBUG_ENABLED && srslte_verbose >= SRSLTE_VERBOSE_INFO && !handler_registered) {
|
|
|
|
printf("d=");
|
|
|
|
srslte_vec_fprint_c(stdout, q->d[tb->cw_idx], tb->nof_re);
|
|
|
|
}
|
|
|
|
|
2020-11-10 11:04:12 -08:00
|
|
|
// Demodulation
|
2020-11-11 03:43:18 -08:00
|
|
|
int8_t* llr = (int8_t*)q->b[tb->cw_idx];
|
|
|
|
if (srslte_demod_soft_demodulate_b(tb->mod, q->d[tb->cw_idx], llr, tb->nof_re)) {
|
2020-11-10 11:04:12 -08:00
|
|
|
return SRSLTE_ERROR;
|
|
|
|
}
|
2020-11-11 07:13:25 -08:00
|
|
|
|
|
|
|
// EVM
|
|
|
|
if (q->evm_buffer != NULL) {
|
|
|
|
res->evm = srslte_evm_run_b(q->evm_buffer, &q->modem_tables[tb->mod], q->d[tb->cw_idx], llr, tb->nof_bits);
|
|
|
|
}
|
|
|
|
|
2020-11-11 03:43:18 -08:00
|
|
|
// Change LLR sign
|
|
|
|
for (uint32_t i = 0; i < tb->nof_bits; i++) {
|
|
|
|
llr[i] = -llr[i];
|
|
|
|
}
|
2020-11-10 11:04:12 -08:00
|
|
|
|
|
|
|
// Descrambling
|
|
|
|
uint32_t n_id = q->carrier.id;
|
|
|
|
if (cfg->scrambling_id_present && SRSLTE_RNTI_ISUSER(rnti)) {
|
|
|
|
n_id = cfg->scambling_id;
|
|
|
|
}
|
|
|
|
uint32_t cinit = ((uint32_t)rnti << 15U) + (tb->cw_idx << 14U) + n_id;
|
|
|
|
srslte_sequence_apply_c(llr, llr, tb->nof_bits, cinit);
|
|
|
|
|
2020-11-11 03:43:18 -08:00
|
|
|
if (SRSLTE_DEBUG_ENABLED && srslte_verbose >= SRSLTE_VERBOSE_INFO && !handler_registered) {
|
|
|
|
printf("b=");
|
|
|
|
srslte_vec_fprint_b(stdout, q->b[tb->cw_idx], tb->nof_bits);
|
|
|
|
}
|
|
|
|
|
2020-11-10 11:04:12 -08:00
|
|
|
// Decode SCH
|
|
|
|
if (srslte_dlsch_nr_decode(&q->sch, &cfg->sch_cfg, tb, llr, res->payload, &res->crc) < SRSLTE_SUCCESS) {
|
|
|
|
ERROR("Error in DL-SCH encoding\n");
|
|
|
|
return SRSLTE_ERROR;
|
|
|
|
}
|
|
|
|
|
|
|
|
return SRSLTE_SUCCESS;
|
|
|
|
}
|
|
|
|
|
|
|
|
int srslte_pdsch_nr_decode(srslte_pdsch_nr_t* q,
|
|
|
|
const srslte_pdsch_cfg_nr_t* cfg,
|
|
|
|
const srslte_pdsch_grant_nr_t* grant,
|
|
|
|
srslte_chest_dl_res_t* channel,
|
|
|
|
cf_t* sf_symbols[SRSLTE_MAX_PORTS],
|
|
|
|
srslte_pdsch_res_nr_t data[SRSLTE_MAX_TB])
|
|
|
|
{
|
2020-11-20 03:12:29 -08:00
|
|
|
// Check input pointers
|
|
|
|
if (!q || !cfg || !grant || !data || !sf_symbols) {
|
|
|
|
return SRSLTE_ERROR_INVALID_INPUTS;
|
|
|
|
}
|
|
|
|
|
|
|
|
struct timeval t[3];
|
|
|
|
if (q->meas_time_en) {
|
|
|
|
gettimeofday(&t[1], NULL);
|
|
|
|
}
|
|
|
|
|
2020-11-10 11:04:12 -08:00
|
|
|
uint32_t nof_cw = 0;
|
|
|
|
for (uint32_t tb = 0; tb < SRSLTE_MAX_TB; tb++) {
|
|
|
|
nof_cw += grant->tb[tb].enabled ? 1 : 0;
|
|
|
|
}
|
|
|
|
|
2020-11-11 03:43:18 -08:00
|
|
|
uint32_t nof_re = srslte_ra_dl_nr_slot_nof_re(cfg, grant);
|
|
|
|
|
2020-11-12 03:48:00 -08:00
|
|
|
if (channel->nof_re != nof_re) {
|
|
|
|
ERROR("Inconsistent number of RE (%d!=%d)\n", channel->nof_re, nof_re);
|
|
|
|
return SRSLTE_ERROR;
|
|
|
|
}
|
|
|
|
|
2020-11-10 11:04:12 -08:00
|
|
|
// Demapping from virtual to physical resource blocks
|
2020-11-12 03:48:00 -08:00
|
|
|
uint32_t nof_re_get = srslte_pdsch_nr_get(q, cfg, grant, q->x[0], sf_symbols[0]);
|
2020-11-11 03:43:18 -08:00
|
|
|
if (nof_re_get != nof_re) {
|
|
|
|
ERROR("Inconsistent number of RE (%d!=%d)\n", nof_re_get, nof_re);
|
|
|
|
return SRSLTE_ERROR;
|
|
|
|
}
|
2020-11-10 11:04:12 -08:00
|
|
|
|
2020-11-12 03:48:00 -08:00
|
|
|
if (SRSLTE_DEBUG_ENABLED && srslte_verbose >= SRSLTE_VERBOSE_INFO && !handler_registered) {
|
|
|
|
INFO("ce=");
|
|
|
|
srslte_vec_fprint_c(stdout, channel->ce[0][0], nof_re);
|
|
|
|
INFO("x=");
|
|
|
|
srslte_vec_fprint_c(stdout, q->x[0], nof_re);
|
|
|
|
}
|
|
|
|
|
2020-11-10 11:04:12 -08:00
|
|
|
// Demapping to virtual resource blocks
|
|
|
|
// ... Not implemented
|
|
|
|
|
|
|
|
// Antenna port demapping
|
|
|
|
// ... Not implemented
|
2020-11-12 03:48:00 -08:00
|
|
|
srslte_predecoding_type(
|
|
|
|
q->x, channel->ce, q->d, NULL, 1, 1, 1, 0, nof_re, SRSLTE_TXSCHEME_PORT0, 1.0f, channel->noise_estimate);
|
2020-11-10 11:04:12 -08:00
|
|
|
|
|
|
|
// Layer demapping
|
|
|
|
if (grant->nof_layers > 1) {
|
2020-11-11 03:43:18 -08:00
|
|
|
srslte_layerdemap_nr(q->d, nof_cw, q->x, grant->nof_layers, nof_re);
|
2020-11-10 11:04:12 -08:00
|
|
|
}
|
|
|
|
|
|
|
|
// SCH decode
|
|
|
|
for (uint32_t tb = 0; tb < SRSLTE_MAX_TB; tb++) {
|
|
|
|
nof_cw += grant->tb[tb].enabled ? 1 : 0;
|
|
|
|
|
|
|
|
if (pdsch_nr_decode_codeword(q, cfg, &grant->tb[tb], &data[tb], grant->rnti) < SRSLTE_SUCCESS) {
|
|
|
|
ERROR("Error encoding TB %d\n", tb);
|
|
|
|
return SRSLTE_ERROR;
|
|
|
|
}
|
|
|
|
}
|
2020-10-20 02:59:59 -07:00
|
|
|
|
2020-11-20 03:12:29 -08:00
|
|
|
if (q->meas_time_en) {
|
|
|
|
gettimeofday(&t[2], NULL);
|
|
|
|
get_time_interval(t);
|
|
|
|
q->meas_time_us = (uint32_t)t[0].tv_usec;
|
|
|
|
}
|
|
|
|
|
2020-10-20 02:59:59 -07:00
|
|
|
return SRSLTE_SUCCESS;
|
2020-11-11 03:43:18 -08:00
|
|
|
}
|
2020-11-20 03:12:29 -08:00
|
|
|
|
|
|
|
static uint32_t srslte_pdsch_nr_grant_info(const srslte_pdsch_cfg_nr_t* cfg,
|
|
|
|
const srslte_pdsch_grant_nr_t* grant,
|
|
|
|
char* str,
|
|
|
|
uint32_t str_len)
|
|
|
|
{
|
|
|
|
uint32_t len = 0;
|
|
|
|
len = srslte_print_check(str, str_len, len, "rnti=0x%x", grant->rnti);
|
|
|
|
|
|
|
|
// Append time-domain resource mapping
|
|
|
|
len = srslte_print_check(str,
|
|
|
|
str_len,
|
|
|
|
len,
|
|
|
|
",k0=%d,S=%d,L=%d,mapping=%s",
|
|
|
|
grant->k0,
|
|
|
|
grant->S,
|
|
|
|
grant->L,
|
|
|
|
srslte_pdsch_mapping_type_to_str(grant->mapping));
|
|
|
|
|
|
|
|
// Skip frequency domain resources...
|
|
|
|
// ...
|
|
|
|
|
|
|
|
// Append spatial resources
|
|
|
|
len = srslte_print_check(str, str_len, len, ",Nl=%d", grant->nof_layers);
|
|
|
|
|
|
|
|
// Append scrambling ID
|
|
|
|
len = srslte_print_check(str, str_len, len, ",n_scid=%d", grant->n_scid);
|
|
|
|
|
|
|
|
// Append TB info
|
|
|
|
for (uint32_t i = 0; i < SRSLTE_MAX_TB; i++) {
|
|
|
|
len += srslte_sch_nr_tb_info(&grant->tb[i], &str[len], str_len - len);
|
|
|
|
}
|
|
|
|
|
|
|
|
return len;
|
|
|
|
}
|
|
|
|
|
|
|
|
uint32_t srslte_pdsch_nr_rx_info(const srslte_pdsch_nr_t* q,
|
|
|
|
const srslte_pdsch_cfg_nr_t* cfg,
|
|
|
|
const srslte_pdsch_grant_nr_t* grant,
|
|
|
|
const srslte_pdsch_res_nr_t res[SRSLTE_MAX_CODEWORDS],
|
|
|
|
char* str,
|
|
|
|
uint32_t str_len)
|
|
|
|
{
|
|
|
|
|
|
|
|
uint32_t len = 0;
|
|
|
|
|
|
|
|
len += srslte_pdsch_nr_grant_info(cfg, grant, &str[len], str_len - len);
|
|
|
|
|
|
|
|
if (q->evm_buffer != NULL) {
|
|
|
|
len = srslte_print_check(str, str_len, len, ",evm={", 0);
|
|
|
|
for (uint32_t i = 0; i < SRSLTE_MAX_CODEWORDS; i++) {
|
|
|
|
if (grant->tb[i].enabled && !isnan(res[i].evm)) {
|
|
|
|
len = srslte_print_check(str, str_len, len, "%.2f", res[i].evm);
|
|
|
|
if (i < SRSLTE_MAX_CODEWORDS - 1) {
|
|
|
|
if (grant->tb[i + 1].enabled) {
|
|
|
|
len = srslte_print_check(str, str_len, len, ",", 0);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
len = srslte_print_check(str, str_len, len, "}", 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (res != NULL) {
|
|
|
|
len = srslte_print_check(str, str_len, len, ",crc={", 0);
|
|
|
|
for (uint32_t i = 0; i < SRSLTE_MAX_CODEWORDS; i++) {
|
|
|
|
if (grant->tb[i].enabled) {
|
|
|
|
len = srslte_print_check(str, str_len, len, "%s", res[i].crc ? "OK" : "KO");
|
|
|
|
if (i < SRSLTE_MAX_CODEWORDS - 1) {
|
|
|
|
if (grant->tb[i + 1].enabled) {
|
|
|
|
len = srslte_print_check(str, str_len, len, ",", 0);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
len = srslte_print_check(str, str_len, len, "}", 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (q->meas_time_en) {
|
|
|
|
len = srslte_print_check(str, str_len, len, ", t=%d us\n", q->meas_time_us);
|
|
|
|
}
|
|
|
|
|
|
|
|
return len;
|
|
|
|
}
|
|
|
|
|
|
|
|
uint32_t srslte_pdsch_nr_tx_info(const srslte_pdsch_nr_t* q,
|
|
|
|
const srslte_pdsch_cfg_nr_t* cfg,
|
|
|
|
const srslte_pdsch_grant_nr_t* grant,
|
|
|
|
char* str,
|
|
|
|
uint32_t str_len)
|
|
|
|
{
|
|
|
|
|
|
|
|
uint32_t len = 0;
|
|
|
|
|
|
|
|
len += srslte_pdsch_nr_grant_info(cfg, grant, &str[len], str_len - len);
|
|
|
|
|
|
|
|
if (q->meas_time_en) {
|
|
|
|
len = srslte_print_check(str, str_len, len, ", t=%d us\n", q->meas_time_us);
|
|
|
|
}
|
|
|
|
|
|
|
|
return len;
|
|
|
|
}
|