Generic SDR support
This commit is contained in:
parent
c5cf88ce57
commit
b30b61282c
|
@ -26,6 +26,9 @@ AC_CANONICAL_HOST
|
|||
|
||||
PKG_CHECK_MODULES(ALSA, alsa >= 1.0)
|
||||
|
||||
have_sdr=no
|
||||
AM_CONDITIONAL(HAVE_SDR, test "x$have_sdr" == "xyes" )
|
||||
|
||||
AC_OUTPUT(
|
||||
src/common/Makefile
|
||||
src/anetz/Makefile
|
||||
|
|
|
@ -26,3 +26,10 @@ libcommon_a_SOURCES = \
|
|||
../common/display_wave.c \
|
||||
../common/main_common.c
|
||||
|
||||
if HAVE_SDR
|
||||
AM_CPPFLAGS += -DHAVE_SDR
|
||||
|
||||
libcommon_a_SOURCES += \
|
||||
../common/sdr.c
|
||||
endif
|
||||
|
||||
|
|
|
@ -54,6 +54,7 @@ struct debug_cat {
|
|||
{ "transaction", "\033[0;32m" },
|
||||
{ "dms", "\033[0;33m" },
|
||||
{ "sms", "\033[1;37m" },
|
||||
{ "sdr", "\033[1;31m" },
|
||||
{ NULL, NULL }
|
||||
};
|
||||
|
||||
|
|
|
@ -19,6 +19,7 @@
|
|||
#define DTRANS 12
|
||||
#define DDMS 13
|
||||
#define DSMS 14
|
||||
#define DSDR 15
|
||||
|
||||
#define PDEBUG(cat, level, fmt, arg...) _printdebug(__FILE__, __FUNCTION__, __LINE__, cat, level, -1, fmt, ## arg)
|
||||
#define PDEBUG_CHAN(cat, level, fmt, arg...) _printdebug(__FILE__, __FUNCTION__, __LINE__, cat, level, CHAN, fmt, ## arg)
|
||||
|
|
|
@ -32,6 +32,9 @@
|
|||
#include "sender.h"
|
||||
#include "timer.h"
|
||||
#include "call.h"
|
||||
#ifdef HAVE_SDR
|
||||
#include "sdr.h"
|
||||
#endif
|
||||
|
||||
/* common settings */
|
||||
int num_kanal = 0;
|
||||
|
@ -54,6 +57,8 @@ int rt_prio = 0;
|
|||
const char *write_rx_wave = NULL;
|
||||
const char *write_tx_wave = NULL;
|
||||
const char *read_rx_wave = NULL;
|
||||
static const char *sdr_args = "";
|
||||
double sdr_rx_gain = 0, sdr_tx_gain = 0;
|
||||
|
||||
void print_help_common(const char *arg0, const char *ext_usage)
|
||||
{
|
||||
|
@ -70,8 +75,9 @@ void print_help_common(const char *arg0, const char *ext_usage)
|
|||
printf(" -k --kanal <channel>\n");
|
||||
printf(" -k --channel <channel>\n");
|
||||
printf(" Channel (German = Kanal) number of \"Sender\" (German = Transceiver)\n");
|
||||
printf(" -a --audio-device hw:<card>,<device>\n");
|
||||
printf(" Sound card and device number (default = '%s')\n", sounddev[0]);
|
||||
printf(" -a --audio-device hw:<card>,<device> | sdr\n");
|
||||
printf(" Sound card and device number (default = '%s')\n", audiodev[0]);
|
||||
printf(" SDR device, if supported\n");
|
||||
printf(" -s --samplerate <rate>\n");
|
||||
printf(" Sample rate of sound device (default = '%d')\n", samplerate);
|
||||
printf(" -i --interval 1..25\n");
|
||||
|
@ -109,6 +115,14 @@ void print_help_common(const char *arg0, const char *ext_usage)
|
|||
printf(" Write transmitted audio to given wav audio file.\n");
|
||||
printf(" --read-rx-wave <file>\n");
|
||||
printf(" Replace received audio by given wav audio file.\n");
|
||||
#ifdef HAVE_SDR
|
||||
printf(" --sdr-args <args>\n");
|
||||
printf(" Optional SDR device arguments\n");
|
||||
printf(" --sdr-rx-gain <gain>\n");
|
||||
printf(" SDR device's RX gain in dB (default = %.1f)\n", sdr_rx_gain);
|
||||
printf(" --sdr-tx-gain <gain>\n");
|
||||
printf(" SDR device's TX gain in dB (default = %.1f)\n", sdr_tx_gain);
|
||||
#endif
|
||||
}
|
||||
|
||||
void print_hotkeys_common(void)
|
||||
|
@ -123,6 +137,9 @@ void print_hotkeys_common(void)
|
|||
#define OPT_WRITE_RX_WAVE 1001
|
||||
#define OPT_WRITE_TX_WAVE 1002
|
||||
#define OPT_READ_RX_WAVE 1003
|
||||
#define OPT_SDR_ARGS 1004
|
||||
#define OPT_SDR_RX_GAIN 1005
|
||||
#define OPT_SDR_TX_GAIN 1006
|
||||
|
||||
static struct option long_options_common[] = {
|
||||
{"help", 0, 0, 'h'},
|
||||
|
@ -144,6 +161,9 @@ static struct option long_options_common[] = {
|
|||
{"write-rx-wave", 1, 0, OPT_WRITE_RX_WAVE},
|
||||
{"write-tx-wave", 1, 0, OPT_WRITE_TX_WAVE},
|
||||
{"read-rx-wave", 1, 0, OPT_READ_RX_WAVE},
|
||||
{"sdr-args", 1, 0, OPT_SDR_ARGS},
|
||||
{"sdr-rx-gain", 1, 0, OPT_SDR_RX_GAIN},
|
||||
{"sdr-tx-gain", 1, 0, OPT_SDR_TX_GAIN},
|
||||
{0, 0, 0, 0}
|
||||
};
|
||||
|
||||
|
@ -283,6 +303,18 @@ void opt_switch_common(int c, char *arg0, int *skip_args)
|
|||
read_rx_wave = strdup(optarg);
|
||||
*skip_args += 2;
|
||||
break;
|
||||
case OPT_SDR_ARGS:
|
||||
sdr_args = strdup(optarg);
|
||||
*skip_args += 2;
|
||||
break;
|
||||
case OPT_SDR_RX_GAIN:
|
||||
sdr_rx_gain = atof(optarg);
|
||||
*skip_args += 2;
|
||||
break;
|
||||
case OPT_SDR_TX_GAIN:
|
||||
sdr_tx_gain = atof(optarg);
|
||||
*skip_args += 2;
|
||||
break;
|
||||
default:
|
||||
exit (0);
|
||||
}
|
||||
|
@ -330,6 +362,10 @@ void main_common(int *quit, int latency, int interval, void (*myhandler)(void))
|
|||
struct termios term, term_orig;
|
||||
int c;
|
||||
|
||||
#ifdef HAVE_SDR
|
||||
if (sdr_init(sdr_args, sdr_rx_gain, sdr_tx_gain))
|
||||
return;
|
||||
#endif
|
||||
|
||||
/* open audio */
|
||||
if (sender_open_audio())
|
||||
|
|
|
@ -0,0 +1,293 @@
|
|||
/* SDR processing
|
||||
*
|
||||
* (C) 2017 by Andreas Eversberg <jolly@eversberg.eu>
|
||||
* All Rights Reserved
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program 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 General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <stdlib.h>
|
||||
#include <stdint.h>
|
||||
#include <string.h>
|
||||
#include <math.h>
|
||||
#include "filter.h"
|
||||
#include "sdr.h"
|
||||
#ifdef HAVE_UHD
|
||||
#include "uhd.h"
|
||||
#endif
|
||||
#include "debug.h"
|
||||
|
||||
//#define FAST_SINE
|
||||
|
||||
typedef struct sdr_chan {
|
||||
double tx_frequency; /* frequency used */
|
||||
double rx_frequency; /* frequency used */
|
||||
double offset; /* offset to calculated center frequency */
|
||||
double tx_phase; /* current phase of FM (used to shift and modulate ) */
|
||||
double rx_rot; /* rotation step per sample to shift rx frequency (used to shift) */
|
||||
double rx_phase; /* current rotation phase (used to shift) */
|
||||
double rx_last_phase; /* last phase of FM (used to demodulate) */
|
||||
filter_lowpass_t rx_lp[2]; /* filters received IQ signal */
|
||||
} sdr_chan_t;
|
||||
|
||||
typedef struct sdr {
|
||||
sdr_chan_t *chan;
|
||||
double spl_deviation; /* how to convert a sample step into deviation (Hz) */
|
||||
int channels; /* number of frequencies */
|
||||
double samplerate; /* IQ rate */
|
||||
double amplitude; /* amplitude of each carrier */
|
||||
} sdr_t;
|
||||
|
||||
static const char *sdr_device_args;
|
||||
static double sdr_rx_gain, sdr_tx_gain;
|
||||
|
||||
#ifdef FAST_SINE
|
||||
static float sdr_sine[256];
|
||||
#endif
|
||||
|
||||
int sdr_init(const char *device_args, double rx_gain, double tx_gain)
|
||||
{
|
||||
#ifdef FAST_SINE
|
||||
int i;
|
||||
|
||||
for (i = 0; i < 256; i++) {
|
||||
sdr_sine[i] = sin(2.0*M_PI*i/256);
|
||||
}
|
||||
#endif
|
||||
|
||||
sdr_device_args = strdup(device_args);
|
||||
sdr_rx_gain = rx_gain;
|
||||
sdr_tx_gain = tx_gain;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
void *sdr_open(const char __attribute__((__unused__)) *audiodev, double *tx_frequency, double *rx_frequency, int channels, int samplerate, double bandwidth, double sample_deviation)
|
||||
{
|
||||
sdr_t *sdr;
|
||||
double center_frequency;
|
||||
int rc;
|
||||
int c;
|
||||
|
||||
if (channels < 1) {
|
||||
PDEBUG(DSDR, DEBUG_ERROR, "No channel given, please fix!\n");
|
||||
abort();
|
||||
}
|
||||
|
||||
sdr = calloc(sizeof(*sdr), 1);
|
||||
if (!sdr) {
|
||||
PDEBUG(DSDR, DEBUG_ERROR, "NO MEM!\n");
|
||||
goto error;
|
||||
}
|
||||
sdr->channels = channels;
|
||||
sdr->samplerate = samplerate;
|
||||
sdr->spl_deviation = sample_deviation;
|
||||
sdr->amplitude = 0.4 / (double)channels; // FIXME: actual amplitude 0.1?
|
||||
|
||||
/* create list of channel states */
|
||||
sdr->chan = calloc(sizeof(*sdr->chan), channels);
|
||||
if (!sdr->chan) {
|
||||
PDEBUG(DSDR, DEBUG_ERROR, "NO MEM!\n");
|
||||
goto error;
|
||||
}
|
||||
for (c = 0; c < channels; c++) {
|
||||
PDEBUG(DSDR, DEBUG_INFO, "Frequency #%d: TX = %.6f MHz, RX = %.6f MHz\n", c, tx_frequency[c] / 1e6, rx_frequency[c] / 1e6);
|
||||
sdr->chan[c].tx_frequency = tx_frequency[c];
|
||||
sdr->chan[c].rx_frequency = rx_frequency[c];
|
||||
#warning check rx frequency is in range
|
||||
filter_lowpass_init(&sdr->chan[c].rx_lp[0], bandwidth, samplerate);
|
||||
filter_lowpass_init(&sdr->chan[c].rx_lp[1], bandwidth, samplerate);
|
||||
}
|
||||
|
||||
/* calculate required bandwidth (IQ rate) */
|
||||
if (channels == 1) {
|
||||
PDEBUG(DSDR, DEBUG_INFO, "Single frequency, so we use sample rate as IQ bandwidth: %.6f MHz\n", sdr->samplerate / 1e6);
|
||||
center_frequency = sdr->chan[0].tx_frequency;
|
||||
} else {
|
||||
double low_frequency = sdr->chan[0].tx_frequency, high_frequency = sdr->chan[0].tx_frequency, range;
|
||||
for (c = 1; c < channels; c++) {
|
||||
if (sdr->chan[c].tx_frequency < low_frequency)
|
||||
low_frequency = sdr->chan[c].tx_frequency;
|
||||
if (sdr->chan[c].tx_frequency > high_frequency)
|
||||
high_frequency = sdr->chan[c].tx_frequency;
|
||||
}
|
||||
range = high_frequency - low_frequency;
|
||||
PDEBUG(DSDR, DEBUG_INFO, "Range between frequencies: %.6f MHz\n", range / 1e6);
|
||||
if (range * 2 > sdr->samplerate) {
|
||||
// why that? actually i don't know. i just want to be safe....
|
||||
PDEBUG(DSDR, DEBUG_NOTICE, "The sample rate must be at least twice the range between frequencies. Please increment samplerate!\n");
|
||||
goto error;
|
||||
}
|
||||
center_frequency = (high_frequency + low_frequency) / 2.0;
|
||||
}
|
||||
PDEBUG(DSDR, DEBUG_INFO, "Using center frequency: %.6f MHz\n", center_frequency / 1e6);
|
||||
for (c = 0; c < channels; c++) {
|
||||
sdr->chan[c].offset = sdr->chan[c].tx_frequency - center_frequency;
|
||||
sdr->chan[c].rx_rot = 2 * M_PI * -sdr->chan[c].offset / sdr->samplerate;
|
||||
PDEBUG(DSDR, DEBUG_INFO, "Frequency #%d offset: %.6f MHz\n", c, sdr->chan[c].offset / 1e6);
|
||||
}
|
||||
PDEBUG(DSDR, DEBUG_INFO, "Using gain: TX %.1f dB, RX %.1f dB\n", sdr_tx_gain, sdr_rx_gain);
|
||||
|
||||
#ifdef HAVE_UHD
|
||||
#warning hack
|
||||
rc = uhd_open(sdr_device_args, center_frequency, center_frequency - sdr->chan[0].tx_frequency + sdr->chan[0].rx_frequency, sdr->samplerate, sdr_rx_gain, sdr_tx_gain);
|
||||
if (rc)
|
||||
goto error;
|
||||
#endif
|
||||
|
||||
return sdr;
|
||||
|
||||
error:
|
||||
sdr_close(sdr);
|
||||
return NULL;
|
||||
}
|
||||
|
||||
void sdr_close(void *inst)
|
||||
{
|
||||
sdr_t *sdr = (sdr_t *)inst;
|
||||
|
||||
#ifdef HAVE_UHD
|
||||
uhd_close();
|
||||
#endif
|
||||
|
||||
if (sdr) {
|
||||
free(sdr->chan);
|
||||
free(sdr);
|
||||
sdr = NULL;
|
||||
}
|
||||
}
|
||||
|
||||
int sdr_write(void *inst, int16_t **samples, int num, int channels)
|
||||
{
|
||||
sdr_t *sdr = (sdr_t *)inst;
|
||||
float buff[num * 2];
|
||||
int c, s, ss;
|
||||
double rate, phase, amplitude, dev;
|
||||
int sent;
|
||||
|
||||
if (channels != sdr->channels) {
|
||||
PDEBUG(DSDR, DEBUG_ERROR, "Invalid number of channels, please fix!\n");
|
||||
abort();
|
||||
}
|
||||
|
||||
/* process all channels */
|
||||
rate = sdr->samplerate;
|
||||
amplitude = sdr->amplitude;
|
||||
memset(buff, 0, sizeof(buff));
|
||||
for (c = 0; c < channels; c++) {
|
||||
/* modulate */
|
||||
phase = sdr->chan[c].tx_phase;
|
||||
for (s = 0, ss = 0; s < num; s++) {
|
||||
/* deviation is defined by the sample value and the offset */
|
||||
dev = sdr->chan[c].offset + (double)samples[c][s] * sdr->spl_deviation;
|
||||
#ifdef FAST_SINE
|
||||
phase += 256.0 * dev / rate;
|
||||
if (phase < 0.0)
|
||||
phase += 256.0;
|
||||
if (phase >= 256.0)
|
||||
phase -= 256.0;
|
||||
buff[ss++] += sdr_sine[((int)phase + 64) & 0xff] * amplitude;
|
||||
buff[ss++] += sdr_sine[(int)phase & 0xff] * amplitude;
|
||||
#else
|
||||
phase += 2.0 * M_PI * dev / rate;
|
||||
if (phase < 0.0)
|
||||
phase += 2.0 * M_PI;
|
||||
if (phase >= 2.0 * M_PI)
|
||||
phase -= 2.0 * M_PI;
|
||||
buff[ss++] += cos(phase) * amplitude;
|
||||
buff[ss++] += sin(phase) * amplitude;
|
||||
#endif
|
||||
}
|
||||
sdr->chan[c].tx_phase = phase;
|
||||
}
|
||||
|
||||
#ifdef HAVE_UHD
|
||||
sent = uhd_send(buff, num);
|
||||
#endif
|
||||
if (sent < 0)
|
||||
return sent;
|
||||
|
||||
return sent;
|
||||
}
|
||||
|
||||
int sdr_read(void *inst, int16_t **samples, int num, int channels)
|
||||
{
|
||||
sdr_t *sdr = (sdr_t *)inst;
|
||||
float buff[num * 2];
|
||||
double I[num], Q[num], i, q;
|
||||
int count;
|
||||
int c, s, ss;
|
||||
double phase, rot, last_phase, spl, dev, rate;
|
||||
|
||||
rate = sdr->samplerate;
|
||||
|
||||
#ifdef HAVE_UHD
|
||||
count = uhd_receive(buff, num);
|
||||
#endif
|
||||
if (count <= 0)
|
||||
return count;
|
||||
|
||||
for (c = 0; c < channels; c++) {
|
||||
rot = sdr->chan[c].rx_rot;
|
||||
phase = sdr->chan[c].rx_phase;
|
||||
for (s = 0, ss = 0; s < count; s++) {
|
||||
phase += rot;
|
||||
i = buff[ss++];
|
||||
q = buff[ss++];
|
||||
I[s] = i * cos(phase) - q * sin(phase);
|
||||
Q[s] = i * sin(phase) + q * cos(phase);
|
||||
}
|
||||
sdr->chan[c].rx_phase = phase;
|
||||
#warning eine interation von 2 führt zu müll (2. kanal gespiegeltes audio), muss man genauer mal analysieren
|
||||
filter_lowpass_process(&sdr->chan[c].rx_lp[0], I, count, 1);
|
||||
filter_lowpass_process(&sdr->chan[c].rx_lp[1], Q, count, 1);
|
||||
last_phase = sdr->chan[c].rx_last_phase;
|
||||
for (s = 0; s < count; s++) {
|
||||
phase = atan2(I[s], Q[s]);
|
||||
dev = (phase - last_phase) / 2 / M_PI;
|
||||
last_phase = phase;
|
||||
if (dev < -0.49)
|
||||
dev += 1.0;
|
||||
else if (dev > 0.49)
|
||||
dev -= 1.0;
|
||||
dev *= rate;
|
||||
spl = dev / sdr->spl_deviation;
|
||||
if (spl > 32766.0)
|
||||
spl = 32766.0;
|
||||
else if (spl < -32766.0)
|
||||
spl = -32766.0;
|
||||
samples[c][s] = spl;
|
||||
}
|
||||
sdr->chan[c].rx_last_phase = last_phase;
|
||||
}
|
||||
|
||||
return count;
|
||||
}
|
||||
|
||||
/* how many delay (in audio sample duration) do we have in the buffer */
|
||||
int sdr_get_inbuffer(void __attribute__((__unused__)) *inst)
|
||||
{
|
||||
// sdr_t *sdr = (sdr_t *)inst;
|
||||
int count;
|
||||
|
||||
#ifdef HAVE_UHD
|
||||
count = uhd_get_inbuffer();
|
||||
#endif
|
||||
if (count < 0)
|
||||
return count;
|
||||
|
||||
return count;
|
||||
}
|
||||
|
||||
|
|
@ -0,0 +1,8 @@
|
|||
|
||||
int sdr_init(const char *device_args, double rx_gain, double tx_gain);
|
||||
void *sdr_open(const char *audiodev, double *tx_frequency, double *rx_frequency, int channels, int samplerate, double bandwidth, double sample_deviation);
|
||||
void sdr_close(void *inst);
|
||||
int sdr_write(void *inst, int16_t **samples, int num, int channels);
|
||||
int sdr_read(void *inst, int16_t **samples, int num, int channels);
|
||||
int sdr_get_inbuffer(void *inst);
|
||||
|
|
@ -49,6 +49,10 @@ int sender_create(sender_t *sender, int kanal, double sendefrequenz, double empf
|
|||
sender->de_emphasis = de_emphasis;
|
||||
sender->loopback = loopback;
|
||||
sender->loss_volume = loss_volume;
|
||||
#ifdef HAVE_SDR
|
||||
if (!strcmp(audiodev, "sdr"))
|
||||
pilot_signal = PILOT_SIGNAL_NONE;
|
||||
#endif
|
||||
sender->pilot_signal = pilot_signal;
|
||||
sender->pilotton_phaseshift = 1.0 / ((double)samplerate / 1000.0);
|
||||
|
||||
|
@ -89,6 +93,19 @@ int sender_create(sender_t *sender, int kanal, double sendefrequenz, double empf
|
|||
slave->slave = sender;
|
||||
} else {
|
||||
/* link audio device */
|
||||
#ifdef HAVE_SDR
|
||||
if (!strcmp(audiodev, "sdr")) {
|
||||
if (pilot_signal != PILOT_SIGNAL_NONE) {
|
||||
PDEBUG(DSENDER, DEBUG_ERROR, "No pilot signal allowed with SDR, please fix!\n");
|
||||
abort();
|
||||
}
|
||||
sender->audio_open = sdr_open;
|
||||
sender->audio_close = sdr_close;
|
||||
sender->audio_read = sdr_read;
|
||||
sender->audio_write = sdr_write;
|
||||
sender->audio_get_inbuffer = sdr_get_inbuffer;
|
||||
} else
|
||||
#endif
|
||||
{
|
||||
sender->audio_open = sound_open;
|
||||
sender->audio_close = sound_close;
|
||||
|
|
|
@ -1,4 +1,7 @@
|
|||
#include "sound.h"
|
||||
#ifdef HAVE_SDR
|
||||
#include "sdr.h"
|
||||
#endif
|
||||
#include "wave.h"
|
||||
#include "samplerate.h"
|
||||
#include "jitter.h"
|
||||
|
|
Loading…
Reference in New Issue