5g-team
/
srsRAN_4G
mirror of https://github.com/pvnis/srsRAN_4G.git
2
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

clean up Soapy RF driver

Browse Source
master
Andre Puschmann 8 years ago
parent caed30bf95
commit f22700e332
2 changed files with 260 additions and 271 deletions
Show Stats Download Patch File Download Diff File

145
srslte/lib/rf/rf_soapy_imp.c
Unescape Escape View File

@ -36,87 +36,91 @@
#include <SoapySDR/Device.h> #include <SoapySDR/Device.h>
#include <SoapySDR/Formats.h> #include <SoapySDR/Formats.h>
//#include "lime/LimeSuite.h"
typedef struct { typedef struct {
SoapySDRKwargs args; SoapySDRKwargs args;
SoapySDRDevice *device; SoapySDRDevice *device;
SoapySDRRange *ranges; SoapySDRRange *ranges;
SoapySDRStream *rxStream; SoapySDRStream *rxStream;
SoapySDRStream *txStream; SoapySDRStream *txStream;
} rf_soapy_handler_t; } rf_soapy_handler_t;
int soapy_error(void *h) int soapy_error(void *h)
{ {
} }
void rf_soapy_get_freq_range(void *h) void rf_soapy_get_freq_range(void *h)
{ {
} }
void rf_soapy_suppress_handler(const char *x) void rf_soapy_suppress_handler(const char *x)
{ {
// not supported // not supported
} }
void rf_soapy_msg_handler(const char *msg) void rf_soapy_msg_handler(const char *msg)
{ {
// not supported // not supported
} }
void rf_soapy_suppress_stdout(void *h) void rf_soapy_suppress_stdout(void *h)
{ {
// not supported // not supported
} }
void rf_soapy_register_error_handler(void *notused, srslte_rf_error_handler_t new_handler) void rf_soapy_register_error_handler(void *notused, srslte_rf_error_handler_t new_handler)
{ {
// not supported // not supported
} }
static bool isLocked(rf_soapy_handler_t *handler, char *sensor_name, void *value_h) static bool isLocked(rf_soapy_handler_t *handler, char *sensor_name, void *value_h)
{ {
// not supported printf("TODO: implement isLocked()\n");
return true; return true;
} }
char* rf_soapy_devname(void* h) char* rf_soapy_devname(void* h)
{ {
printf("TODO: implement rf_soapy_devname()\n");
} }
bool rf_soapy_rx_wait_lo_locked(void *h) bool rf_soapy_rx_wait_lo_locked(void *h)
{ {
// not supported printf("TODO: implement rf_soapy_rx_wait_lo_locked()\n");
return true; return true;
} }
void rf_soapy_set_tx_cal(void *h, srslte_rf_cal_t *cal) void rf_soapy_set_tx_cal(void *h, srslte_rf_cal_t *cal)
{ {
printf("TODO: implement rf_soapy_rx_wait_lo_locked()\n");
// not supported // not supported
} }
void rf_soapy_set_rx_cal(void *h, srslte_rf_cal_t *cal) void rf_soapy_set_rx_cal(void *h, srslte_rf_cal_t *cal)
{ {
// not supported printf("TODO: implement rf_soapy_set_rx_cal()\n");
} }
int rf_soapy_start_rx_stream(void *h) int rf_soapy_start_rx_stream(void *h)
{ {
//printf("starting SOAPY rx stream \n");
rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h; rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h;
//SoapySDRStream *rxStream;
if(SoapySDRDevice_activateStream(handler->device, handler->rxStream, 0, 0, 0)!=0)//start streaming if (SoapySDRDevice_activateStream(handler->device, handler->rxStream, 0, 0, 0) != 0)
return SRSLTE_ERROR; return SRSLTE_ERROR;
return SRSLTE_SUCCESS; return SRSLTE_SUCCESS;
} }
@ -124,41 +128,38 @@ int rf_soapy_start_rx_stream(void *h)
int rf_soapy_start_tx_stream(void *h) int rf_soapy_start_tx_stream(void *h)
{ {
rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h; rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h;
//SoapySDRStream *rxStream; if (SoapySDRDevice_setupStream(handler->device, &(handler->txStream), SOAPY_SDR_TX, SOAPY_SDR_CF32, NULL, 0, NULL) != 0) {
if (SoapySDRDevice_setupStream(handler->device, &(handler->txStream), SOAPY_SDR_TX, SOAPY_SDR_CF32, NULL, 0, NULL) != 0)
{
printf("setupStream fail: %s\n", SoapySDRDevice_lastError()); printf("setupStream fail: %s\n", SoapySDRDevice_lastError());
return SRSLTE_ERROR; return SRSLTE_ERROR;
} }
if(SoapySDRDevice_activateStream(handler->device, handler->txStream, 0, 0, 0) != 0) if(SoapySDRDevice_activateStream(handler->device, handler->txStream, 0, 0, 0) != 0)
return SRSLTE_ERROR; return SRSLTE_ERROR;
return SRSLTE_SUCCESS; return SRSLTE_SUCCESS;
} }
int rf_soapy_stop_rx_stream(void *h) int rf_soapy_stop_rx_stream(void *h)
{ {
rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h; rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h;
if(SoapySDRDevice_deactivateStream(handler->device, handler->rxStream, 0, 0) != 0) if (SoapySDRDevice_deactivateStream(handler->device, handler->rxStream, 0, 0) != 0)
return SRSLTE_ERROR; return SRSLTE_ERROR;
return SRSLTE_SUCCESS; return SRSLTE_SUCCESS;
} }
int rf_soapy_stop_tx_stream(void *h) int rf_soapy_stop_tx_stream(void *h)
{ {
rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h; rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h;
if(SoapySDRDevice_deactivateStream(handler->device, handler->txStream, 0, 0) != 0) if(SoapySDRDevice_deactivateStream(handler->device, handler->txStream, 0, 0) != 0)
return SRSLTE_ERROR; return SRSLTE_ERROR;
return SRSLTE_SUCCESS; return SRSLTE_SUCCESS;
} }
void rf_soapy_flush_buffer(void *h) void rf_soapy_flush_buffer(void *h)
{ {
int n; int n;
@ -170,29 +171,33 @@ void rf_soapy_flush_buffer(void *h)
} while (n > 0); } while (n > 0);
} }
bool rf_soapy_has_rssi(void *h) bool rf_soapy_has_rssi(void *h)
{ {
printf("TODO: implement rf_soapy_has_rssi()\n");
return false;
} }
float rf_soapy_get_rssi(void *h) float rf_soapy_get_rssi(void *h)
{ {
printf("TODO: implement rf_soapy_get_rssi()\n");
return 0.0;
} }
//TODO: add multi-channel support //TODO: add multi-channel support
int rf_soapy_open_multi(char *args, void **h, uint32_t nof_rx_antennas) int rf_soapy_open_multi(char *args, void **h, uint32_t nof_rx_antennas)
{//SoapySDRKwargs soapy_args = {}; {
size_t length; size_t length;
const SoapySDRKwargs *soapy_args = SoapySDRDevice_enumerate(NULL, &length); const SoapySDRKwargs *soapy_args = SoapySDRDevice_enumerate(NULL, &length);
if(length == 0) if (length == 0) {
{ printf("No Soapy devices found.\n");
return SRSLTE_ERROR; return SRSLTE_ERROR;
} }
for (size_t i = 0; i < length; i++) for (size_t i = 0; i < length; i++) {
{
printf("Soapy Has Found device #%d: ", (int)i); printf("Soapy Has Found device #%d: ", (int)i);
for (size_t j = 0; j < soapy_args[i].size; j++) for (size_t j = 0; j < soapy_args[i].size; j++)
{ {
@ -201,38 +206,27 @@ int rf_soapy_open_multi(char *args, void **h, uint32_t nof_rx_antennas)
printf("\n"); printf("\n");
} }
// SoapySDRrgs_set(&soapy_args, "driver", "rtlsdr");
SoapySDRDevice *sdr = SoapySDRDevice_make(&(soapy_args[0])); SoapySDRDevice *sdr = SoapySDRDevice_make(&(soapy_args[0]));
if (sdr == NULL) {
if(sdr == NULL)
{
printf("failed to create SOAPY object\n"); printf("failed to create SOAPY object\n");
return SRSLTE_ERROR; return SRSLTE_ERROR;
} }
//SoapySDRKwargs_clear(&soapy_args); // create handler
rf_soapy_handler_t *handler = (rf_soapy_handler_t*) malloc(sizeof(rf_soapy_handler_t)); rf_soapy_handler_t *handler = (rf_soapy_handler_t*) malloc(sizeof(rf_soapy_handler_t));
bzero(handler, sizeof(rf_soapy_handler_t));
*h = handler; *h = handler;
handler->device = sdr; handler->device = sdr;
if (SoapySDRDevice_setupStream(handler->device, &(handler->rxStream), SOAPY_SDR_RX, SOAPY_SDR_CF32, NULL, 0, NULL) != 0) {
//size_t channels[1];
//channels[0] = 0;
if (SoapySDRDevice_setupStream(handler->device, &(handler->rxStream), SOAPY_SDR_RX, SOAPY_SDR_CF32, NULL, 0, NULL) != 0)
{
printf("setupStream fail: %s\n", SoapySDRDevice_lastError()); printf("setupStream fail: %s\n", SoapySDRDevice_lastError());
return SRSLTE_ERROR; return SRSLTE_ERROR;
} }
return SRSLTE_SUCCESS; return SRSLTE_SUCCESS;
} }
int rf_soapy_open(char *args, void **h) int rf_soapy_open(char *args, void **h)
{ {
return rf_soapy_open_multi(args, h, 1); return rf_soapy_open_multi(args, h, 1);
@ -242,28 +236,38 @@ int rf_soapy_open(char *args, void **h)
int rf_soapy_close(void *h) int rf_soapy_close(void *h)
{ {
rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h; rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h;
if (handler->txStream) {
rf_soapy_stop_tx_stream(handler);
SoapySDRDevice_closeStream(handler->device, handler->txStream); SoapySDRDevice_closeStream(handler->device, handler->txStream);
}
if (handler->rxStream) {
rf_soapy_stop_rx_stream(handler);
SoapySDRDevice_closeStream(handler->device, handler->rxStream); SoapySDRDevice_closeStream(handler->device, handler->rxStream);
}
SoapySDRDevice_unmake(handler->device); SoapySDRDevice_unmake(handler->device);
free(handler);
} }
void rf_soapy_set_master_clock_rate(void *h, double rate) void rf_soapy_set_master_clock_rate(void *h, double rate)
{ {
// Allow the soapy to automatically set the appropriate clock rate // Allow the soapy to automatically set the appropriate clock rate
printf("SET MASTER CLOCK RATE\n"); printf("SET MASTER CLOCK RATE\n");
} }
bool rf_soapy_is_master_clock_dynamic(void *h) bool rf_soapy_is_master_clock_dynamic(void *h)
{ {
printf("TODO: implement rf_soapy_is_master_clock_dynamic()\n");
return false;
} }
double rf_soapy_set_rx_srate(void *h, double rate) double rf_soapy_set_rx_srate(void *h, double rate)
{ {
rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h; rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h;
if (SoapySDRDevice_setSampleRate(handler->device, SOAPY_SDR_RX, 0, rate) != 0) if (SoapySDRDevice_setSampleRate(handler->device, SOAPY_SDR_RX, 0, rate) != 0) {
{
printf("setSampleRate fail: %s\n", SoapySDRDevice_lastError()); printf("setSampleRate fail: %s\n", SoapySDRDevice_lastError());
return SRSLTE_ERROR; return SRSLTE_ERROR;
} }
@ -276,8 +280,7 @@ double rf_soapy_set_rx_srate(void *h, double rate)
double rf_soapy_set_tx_srate(void *h, double rate) double rf_soapy_set_tx_srate(void *h, double rate)
{ {
rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h; rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h;
if (SoapySDRDevice_setSampleRate(handler->device, SOAPY_SDR_TX, 0, rate) != 0) if (SoapySDRDevice_setSampleRate(handler->device, SOAPY_SDR_TX, 0, rate) != 0) {
{
printf("setSampleRate fail: %s\n", SoapySDRDevice_lastError()); printf("setSampleRate fail: %s\n", SoapySDRDevice_lastError());
return SRSLTE_ERROR; return SRSLTE_ERROR;
} }
@ -286,9 +289,9 @@ double rf_soapy_set_tx_srate(void *h, double rate)
return ret; return ret;
} }
double rf_soapy_set_rx_gain(void *h, double gain) double rf_soapy_set_rx_gain(void *h, double gain)
{ {
rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h; rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h;
if (SoapySDRDevice_setGain(handler->device, SOAPY_SDR_RX, 0, gain) != 0) if (SoapySDRDevice_setGain(handler->device, SOAPY_SDR_RX, 0, gain) != 0)
{ {
@ -296,10 +299,11 @@ double rf_soapy_set_rx_gain(void *h, double gain)
return SRSLTE_ERROR; return SRSLTE_ERROR;
} }
double ret = rf_soapy_get_rx_gain(h); double ret = rf_soapy_get_rx_gain(h);
printf("gain has been set to %f.2 \n",ret); printf("Rx gain has been set to %f.2 \n",ret);
return ret; return ret;
} }
double rf_soapy_set_tx_gain(void *h, double gain) double rf_soapy_set_tx_gain(void *h, double gain)
{ {
rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h; rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h;
@ -309,27 +313,27 @@ double rf_soapy_set_tx_gain(void *h, double gain)
return SRSLTE_ERROR; return SRSLTE_ERROR;
} }
double ret = rf_soapy_get_rx_gain(h); double ret = rf_soapy_get_rx_gain(h);
printf("gain has been set to %f.2 \n",ret); printf("Tx gain has been set to %f.2 \n",ret);
return ret; return ret;
} }
double rf_soapy_get_rx_gain(void *h) double rf_soapy_get_rx_gain(void *h)
{ {
rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h; rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h;
return SoapySDRDevice_getGain(handler->device,SOAPY_SDR_RX,0); return SoapySDRDevice_getGain(handler->device,SOAPY_SDR_RX,0);
} }
double rf_soapy_get_tx_gain(void *h) double rf_soapy_get_tx_gain(void *h)
{ {
rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h; rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h;
return SoapySDRDevice_getGain(handler->device,SOAPY_SDR_TX,0); return SoapySDRDevice_getGain(handler->device,SOAPY_SDR_TX,0);
} }
double rf_soapy_set_rx_freq(void *h, double freq) double rf_soapy_set_rx_freq(void *h, double freq)
{ {
rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h; rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h;
if (SoapySDRDevice_setFrequency(handler->device, SOAPY_SDR_RX, 0, freq, NULL) != 0) if (SoapySDRDevice_setFrequency(handler->device, SOAPY_SDR_RX, 0, freq, NULL) != 0)
{ {
@ -338,9 +342,8 @@ double rf_soapy_set_rx_freq(void *h, double freq)
} }
double ret = SoapySDRDevice_getFrequency(handler->device, SOAPY_SDR_RX, 0); double ret = SoapySDRDevice_getFrequency(handler->device, SOAPY_SDR_RX, 0);
printf("Frequency has been set to %f : \n",ret); printf("Rx frequency has been set to %f : \n",ret);
return ret; return ret;
} }
double rf_soapy_set_tx_freq(void *h, double freq) double rf_soapy_set_tx_freq(void *h, double freq)
@ -352,7 +355,7 @@ double rf_soapy_set_tx_freq(void *h, double freq)
return SRSLTE_ERROR; return SRSLTE_ERROR;
} }
double ret = SoapySDRDevice_getFrequency(handler->device, SOAPY_SDR_RX, 0); double ret = SoapySDRDevice_getFrequency(handler->device, SOAPY_SDR_RX, 0);
printf("Frequency has been set to %f : \n",ret); printf("Tx frequency has been set to %f : \n",ret);
return ret; return ret;
} }
@ -381,8 +384,7 @@ int rf_soapy_recv_with_time_multi(void *h,
int ret = 0; int ret = 0;
long long timeNs; //timestamp for receive buffer long long timeNs; //timestamp for receive buffer
int n = 0; int n = 0;
do{ do {
size_t rx_samples = nsamples; size_t rx_samples = nsamples;
if (rx_samples > nsamples - n) if (rx_samples > nsamples - n)
@ -390,7 +392,7 @@ int rf_soapy_recv_with_time_multi(void *h,
rx_samples = nsamples - n; rx_samples = nsamples - n;
} }
void *buffs_ptr[4]; void *buffs_ptr[4];
for (int i=0;i<num_channels;i++) for (int i=0; i<num_channels; i++)
{ {
cf_t *data_c = (cf_t*) data[i]; cf_t *data_c = (cf_t*) data[i];
buffs_ptr[i] = &data_c[n]; buffs_ptr[i] = &data_c[n];
@ -401,15 +403,13 @@ int rf_soapy_recv_with_time_multi(void *h,
return SRSLTE_ERROR; return SRSLTE_ERROR;
n += ret; n += ret;
trials++; trials++;
}while (n < nsamples && trials < 100); } while (n < nsamples && trials < 100);
//*secs = timeNs / 1000000000; //*secs = timeNs / 1000000000;
//*frac_secs = (timeNs % 1000000000)/1000000000; //*frac_secs = (timeNs % 1000000000)/1000000000;
// printf("ret=%d, flags=%d, timeNs=%lld\n", ret, flags, timeNs); // printf("ret=%d, flags=%d, timeNs=%lld\n", ret, flags, timeNs);
return n; return n;
} }
int rf_soapy_recv_with_time(void *h, int rf_soapy_recv_with_time(void *h,
@ -433,25 +433,14 @@ int rf_soapy_send_timed(void *h,
bool is_start_of_burst, bool is_start_of_burst,
bool is_end_of_burst) bool is_end_of_burst)
{ {
int flags; int flags;
long long timeNs; long long timeNs;
rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h; rf_soapy_handler_t *handler = (rf_soapy_handler_t*) h;
timeNs = secs * 1000000000; timeNs = secs * 1000000000;
timeNs = timeNs + (frac_secs * 1000000000); timeNs = timeNs + (frac_secs * 1000000000);
int ret = SoapySDRDevice_writeStream(handler->device, handler->txStream, &data, nsamples, &flags, timeNs, 100000); int ret = SoapySDRDevice_writeStream(handler->device, handler->txStream, &data, nsamples, &flags, timeNs, 100000);
if(ret != nsamples) if(ret != nsamples)
return SRSLTE_ERROR; return SRSLTE_ERROR;
return ret; return ret;
} }

4
srslte/lib/rf/rf_soapy_imp.h
Unescape Escape View File

@ -30,10 +30,10 @@
#include "srslte/rf/rf.h" #include "srslte/rf/rf.h"
SRSLTE_API int rf_soapy_open( char *args, SRSLTE_API int rf_soapy_open(char *args,
void **handler); void **handler);
SRSLTE_API int rf_soapy_open_multi( char *args, SRSLTE_API int rf_soapy_open_multi(char *args,
void **handler, void **handler,
uint32_t nof_rx_antennas); uint32_t nof_rx_antennas);

Write Preview
Loading…
Cancel
Save