mirror of https://github.com/pvnis/srsRAN_4G.git
You cannot select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
205 lines
5.0 KiB
C
205 lines
5.0 KiB
C
10 years ago
|
/**
|
||
|
*
|
||
|
* \section COPYRIGHT
|
||
|
*
|
||
|
* Copyright 2013-2014 The libLTE Developers. See the
|
||
|
* COPYRIGHT file at the top-level directory of this distribution.
|
||
|
*
|
||
|
* \section LICENSE
|
||
|
*
|
||
|
* This file is part of the libLTE library.
|
||
|
*
|
||
|
* libLTE is free software: you can redistribute it and/or modify
|
||
|
* it under the terms of the GNU Lesser General Public License as
|
||
|
* published by the Free Software Foundation, either version 3 of
|
||
|
* the License, or (at your option) any later version.
|
||
|
*
|
||
|
* libLTE is distributed in the hope that it will be useful,
|
||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
|
* GNU Lesser General Public License for more details.
|
||
|
*
|
||
|
* A copy of the GNU Lesser General Public License can be found in
|
||
|
* the LICENSE file in the top-level directory of this distribution
|
||
|
* and at http://www.gnu.org/licenses/.
|
||
|
*
|
||
|
*/
|
||
|
|
||
|
|
||
|
#include <stdio.h>
|
||
|
#include <stdlib.h>
|
||
|
#include <string.h>
|
||
10 years ago
|
#include <unistd.h>
|
||
10 years ago
|
|
||
|
#include "iodev.h"
|
||
|
|
||
|
#include "liblte/phy/io/filesource.h"
|
||
10 years ago
|
#include "liblte/phy/ue/ue_sync.h"
|
||
10 years ago
|
#include "liblte/phy/utils/debug.h"
|
||
|
#include "liblte/phy/utils/vector.h"
|
||
|
|
||
|
#ifndef DISABLE_UHD
|
||
|
#include "liblte/cuhd/cuhd.h"
|
||
|
#endif
|
||
|
|
||
10 years ago
|
#include "cell_search_utils.h"
|
||
|
|
||
10 years ago
|
|
||
|
int cuhd_recv_wrapper(void *h, void *data, uint32_t nsamples) {
|
||
|
DEBUG(" ---- Receive %d samples ---- \n", nsamples);
|
||
|
return cuhd_recv(h, data, nsamples, 1);
|
||
|
}
|
||
|
|
||
|
/* Setup USRP or input file */
|
||
10 years ago
|
int iodev_init(iodev_t *q, iodev_cfg_t *config, lte_cell_t *cell) {
|
||
10 years ago
|
|
||
|
if (config->input_file_name) {
|
||
10 years ago
|
|
||
10 years ago
|
cell->phich_resources = R_1;
|
||
|
cell->phich_length = PHICH_NORM;
|
||
10 years ago
|
|
||
|
cell->id = config->cell_id_file;
|
||
|
cell->cp = CPNORM;
|
||
|
cell->nof_ports = config->nof_ports_file;
|
||
|
cell->nof_prb = config->nof_prb_file;
|
||
|
|
||
10 years ago
|
if (filesource_init(&q->fsrc, config->input_file_name, COMPLEX_FLOAT_BIN)) {
|
||
|
return LIBLTE_ERROR;
|
||
|
}
|
||
10 years ago
|
q->mode = FILESOURCE;
|
||
|
int symbol_sz = lte_symbol_sz(cell->nof_prb);
|
||
|
if (symbol_sz > 0) {
|
||
|
q->sf_len = SF_LEN(symbol_sz);
|
||
|
} else {
|
||
|
fprintf(stderr, "Invalid number of PRB %d\n", cell->nof_prb);
|
||
|
return LIBLTE_ERROR;
|
||
|
}
|
||
|
|
||
|
q->input_buffer_file = vec_malloc(q->sf_len * sizeof(cf_t));
|
||
10 years ago
|
if (!q->input_buffer_file) {
|
||
|
perror("malloc");
|
||
|
return LIBLTE_ERROR;
|
||
|
}
|
||
10 years ago
|
q->sf_idx = 9;
|
||
10 years ago
|
|
||
|
} else {
|
||
10 years ago
|
|
||
|
#ifndef DISABLE_UHD
|
||
|
|
||
10 years ago
|
printf("Opening UHD device...\n");
|
||
|
if (cuhd_open(config->uhd_args, &q->uhd)) {
|
||
|
fprintf(stderr, "Error opening uhd\n");
|
||
|
return LIBLTE_ERROR;
|
||
|
}
|
||
10 years ago
|
/* Set receiver gain */
|
||
10 years ago
|
cuhd_set_rx_gain(q->uhd, config->uhd_gain);
|
||
10 years ago
|
|
||
|
/* set receiver frequency */
|
||
10 years ago
|
cuhd_set_rx_freq(q->uhd, (double) config->uhd_freq);
|
||
|
cuhd_rx_wait_lo_locked(q->uhd);
|
||
|
DEBUG("Set uhd_freq to %.3f MHz\n", (double ) config->uhd_freq);
|
||
|
|
||
10 years ago
|
if (cell_search(q->uhd, config->force_N_id_2, cell)) {
|
||
10 years ago
|
fprintf(stderr, "Cell not found\n");
|
||
|
return LIBLTE_ERROR;
|
||
10 years ago
|
}
|
||
|
|
||
10 years ago
|
cuhd_start_rx_stream(q->uhd);
|
||
10 years ago
|
|
||
10 years ago
|
if (ue_sync_init(&q->sframe, *cell, cuhd_recv_wrapper, q->uhd)) {
|
||
|
fprintf(stderr, "Error initiating ue_sync\n");
|
||
|
return LIBLTE_ERROR;
|
||
|
}
|
||
|
|
||
10 years ago
|
// Here, the subframe length and input buffer is managed by ue_sync
|
||
|
q->mode = UHD;
|
||
|
|
||
|
#else
|
||
|
printf("Error UHD not available. Select an input file\n");
|
||
|
return LIBLTE_ERROR;
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
memcpy(&q->config, config, sizeof(iodev_cfg_t));
|
||
|
|
||
|
return LIBLTE_SUCCESS;
|
||
|
}
|
||
|
|
||
|
|
||
|
|
||
|
void iodev_free(iodev_t *q) {
|
||
|
|
||
|
if (q->mode == FILESOURCE) {
|
||
|
filesource_free(&q->fsrc);
|
||
|
} else {
|
||
|
#ifndef DISABLE_UHD
|
||
|
cuhd_close(q->uhd);
|
||
|
#endif
|
||
|
}
|
||
|
}
|
||
|
/* Receive samples from the USRP or read from file */
|
||
|
int iodev_receive(iodev_t *q, cf_t **buffer) {
|
||
|
int n;
|
||
|
if (q->mode == FILESOURCE) {
|
||
10 years ago
|
INFO(" ----- READING %d SAMPLES ---- \n", q->sf_len);
|
||
10 years ago
|
n = filesource_read(&q->fsrc, q->input_buffer_file, q->sf_len);
|
||
|
*buffer = q->input_buffer_file;
|
||
|
if (n == -1) {
|
||
|
fprintf(stderr, "Error reading file\n");
|
||
|
/* wrap file if arrive to end */
|
||
|
} else if (n < q->sf_len) {
|
||
|
DEBUG("Read %d from file. Seeking to 0\n",n);
|
||
|
filesource_seek(&q->fsrc, 0);
|
||
|
n = filesource_read(&q->fsrc, q->input_buffer_file, q->sf_len);
|
||
|
if (n == -1) {
|
||
|
fprintf(stderr, "Error reading file\n");
|
||
|
/* wrap file if arrive to end */
|
||
|
} else {
|
||
|
n = 1;
|
||
|
}
|
||
|
} else {
|
||
|
n = 1;
|
||
|
}
|
||
10 years ago
|
q->sf_idx++;
|
||
|
if (q->sf_idx == 10) {
|
||
|
q->sf_idx = 0;
|
||
|
}
|
||
|
usleep(5000);
|
||
10 years ago
|
} else {
|
||
|
/* Use ue_sync_work which returns a synchronized buffer of subframe samples */
|
||
|
#ifndef DISABLE_UHD
|
||
|
n = ue_sync_get_buffer(&q->sframe, buffer);
|
||
|
if (n < 0) {
|
||
|
fprintf(stderr, "Error calling ue_sync_work()\n");
|
||
|
}
|
||
|
#endif
|
||
|
}
|
||
|
return n;
|
||
|
}
|
||
|
|
||
|
void* iodev_get_cuhd(iodev_t *q) {
|
||
|
if (q->mode == UHD) {
|
||
|
return q->uhd;
|
||
|
} else {
|
||
|
return NULL;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
bool iodev_isfile(iodev_t *q) {
|
||
|
return q->mode == FILESOURCE;
|
||
|
}
|
||
|
|
||
|
bool iodev_isUSRP(iodev_t *q) {
|
||
|
return q->mode == UHD;
|
||
|
}
|
||
|
|
||
10 years ago
|
uint32_t iodev_get_sfidx(iodev_t *q) {
|
||
|
if (iodev_isfile(q)) {
|
||
|
return q->sf_idx;
|
||
|
} else {
|
||
|
return ue_sync_get_sfidx(&q->sframe);
|
||
|
}
|
||
|
}
|
||
|
|
||
10 years ago
|
|