2012-04-06 13:29:14 +00:00
|
|
|
/* -*- c++ -*- */
|
|
|
|
/*
|
|
|
|
* Copyright 2012 Dimitri Stolnikov <horiz0n@gmx.net>
|
|
|
|
*
|
|
|
|
* GNU Radio 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, or (at your option)
|
|
|
|
* any later version.
|
|
|
|
*
|
|
|
|
* GNU Radio 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 GNU Radio; see the file COPYING. If not, write to
|
|
|
|
* the Free Software Foundation, Inc., 51 Franklin Street,
|
|
|
|
* Boston, MA 02110-1301, USA.
|
|
|
|
*/
|
|
|
|
|
|
|
|
/*
|
|
|
|
* config.h is generated by configure. It contains the results
|
|
|
|
* of probing for features, options etc. It should be the first
|
|
|
|
* file included in your .cc file.
|
|
|
|
*/
|
|
|
|
#ifdef HAVE_CONFIG_H
|
|
|
|
#include "config.h"
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#include <rtl_source_c.h>
|
|
|
|
#include <gr_io_signature.h>
|
|
|
|
|
2012-04-11 21:37:02 +00:00
|
|
|
#include <boost/assign.hpp>
|
2012-04-29 17:53:17 +00:00
|
|
|
#include <boost/format.hpp>
|
2012-04-11 21:37:02 +00:00
|
|
|
|
2012-04-06 13:29:14 +00:00
|
|
|
#include <stdexcept>
|
|
|
|
#include <iostream>
|
|
|
|
#include <stdio.h>
|
|
|
|
|
|
|
|
#include <rtl-sdr.h>
|
|
|
|
|
2012-04-28 18:18:14 +00:00
|
|
|
#include <osmosdr_arg_helpers.h>
|
|
|
|
|
2012-04-11 21:37:02 +00:00
|
|
|
using namespace boost::assign;
|
|
|
|
|
2012-04-26 17:14:42 +00:00
|
|
|
#define BUF_SIZE (16 * 32 * 512)
|
|
|
|
|
2012-04-06 13:29:14 +00:00
|
|
|
/*
|
|
|
|
* Create a new instance of rtl_source_c and return
|
|
|
|
* a boost shared_ptr. This is effectively the public constructor.
|
|
|
|
*/
|
|
|
|
rtl_source_c_sptr
|
|
|
|
make_rtl_source_c (const std::string &args)
|
|
|
|
{
|
|
|
|
return gnuradio::get_initial_sptr(new rtl_source_c (args));
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Specify constraints on number of input and output streams.
|
|
|
|
* This info is used to construct the input and output signatures
|
|
|
|
* (2nd & 3rd args to gr_block's constructor). The input and
|
|
|
|
* output signatures are used by the runtime system to
|
|
|
|
* check that a valid number and type of inputs and outputs
|
|
|
|
* are connected to this block. In this case, we accept
|
2012-04-28 18:18:14 +00:00
|
|
|
* only 0 input and 1 output.
|
2012-04-06 13:29:14 +00:00
|
|
|
*/
|
|
|
|
static const int MIN_IN = 0; // mininum number of input streams
|
|
|
|
static const int MAX_IN = 0; // maximum number of input streams
|
|
|
|
static const int MIN_OUT = 1; // minimum number of output streams
|
|
|
|
static const int MAX_OUT = 1; // maximum number of output streams
|
|
|
|
|
|
|
|
/*
|
|
|
|
* The private constructor
|
|
|
|
*/
|
|
|
|
rtl_source_c::rtl_source_c (const std::string &args)
|
|
|
|
: gr_sync_block ("rtl_source_c",
|
|
|
|
gr_make_io_signature (MIN_IN, MAX_IN, sizeof (gr_complex)),
|
|
|
|
gr_make_io_signature (MIN_OUT, MAX_OUT, sizeof (gr_complex)))
|
|
|
|
{
|
|
|
|
int ret;
|
2012-04-29 17:53:17 +00:00
|
|
|
unsigned int dev_index = 0, rtl_freq = 0, tuner_freq = 0;
|
2012-04-28 18:18:14 +00:00
|
|
|
|
|
|
|
dict_t dict = params_to_dict(args);
|
2012-04-26 17:14:42 +00:00
|
|
|
|
2012-04-28 18:18:14 +00:00
|
|
|
if (dict.count("rtl"))
|
|
|
|
dev_index = boost::lexical_cast< unsigned int >( dict["rtl"] );
|
2012-04-26 17:14:42 +00:00
|
|
|
|
2012-04-29 17:53:17 +00:00
|
|
|
if (dict.count("rtl_xtal"))
|
|
|
|
rtl_freq = (unsigned int)boost::lexical_cast< double >( dict["rtl_xtal"] );
|
|
|
|
|
|
|
|
if (dict.count("tuner_xtal"))
|
|
|
|
tuner_freq = (unsigned int)boost::lexical_cast< double >( dict["tuner_xtal"] );
|
|
|
|
|
2012-04-26 17:14:42 +00:00
|
|
|
_buf_num = 32;
|
|
|
|
_buf = (unsigned short **) malloc(_buf_num * sizeof(unsigned short *));
|
2012-04-06 13:29:14 +00:00
|
|
|
|
2012-04-26 17:14:42 +00:00
|
|
|
for(unsigned int i = 0; i < _buf_num; ++i)
|
|
|
|
_buf[i] = (unsigned short *) malloc(BUF_SIZE);
|
|
|
|
|
|
|
|
_buf_head = _buf_used = _buf_offset = 0;
|
|
|
|
_samp_avail = BUF_SIZE;
|
2012-04-06 13:29:14 +00:00
|
|
|
|
|
|
|
// create a lookup table for gr_complex values
|
2012-04-26 17:14:42 +00:00
|
|
|
for (unsigned int i = 0; i <= 0xffff; i++) {
|
2012-04-06 16:52:26 +00:00
|
|
|
#if 1 // little endian
|
2012-04-09 20:47:46 +00:00
|
|
|
_lut.push_back( gr_complex( (float(i & 0xff) - 127.5f) *(1.0f/128.0f),
|
|
|
|
(float(i >> 8) - 127.5f) * (1.0f/128.0f) ) );
|
2012-04-06 16:52:26 +00:00
|
|
|
#else // big endian
|
2012-04-09 20:47:46 +00:00
|
|
|
_lut.push_back( gr_complex( (float(i >> 8) - 127.5f) * (1.0f/128.0f),
|
|
|
|
(float(i & 0xff) - 127.5f) * (1.0f/128.0f) ) );
|
2012-04-06 16:52:26 +00:00
|
|
|
#endif
|
2012-04-06 13:29:14 +00:00
|
|
|
}
|
|
|
|
|
2012-04-26 17:14:42 +00:00
|
|
|
if ( dev_index >= rtlsdr_get_device_count() )
|
|
|
|
throw std::runtime_error("Device index out of bounds for rtlsdr.");
|
|
|
|
|
2012-04-11 21:37:02 +00:00
|
|
|
std::cerr << "Using device #" << dev_index << " "
|
|
|
|
<< "(" << rtlsdr_get_device_name(dev_index) << ")"
|
|
|
|
<< std::endl;
|
2012-04-06 13:29:14 +00:00
|
|
|
|
|
|
|
_dev = NULL;
|
2012-04-11 21:37:02 +00:00
|
|
|
ret = rtlsdr_open( &_dev, dev_index );
|
|
|
|
if (ret < 0)
|
|
|
|
throw std::runtime_error("Failed to open rtlsdr device.");
|
|
|
|
|
2012-04-29 17:53:17 +00:00
|
|
|
if (rtl_freq > 0 || tuner_freq > 0) {
|
|
|
|
if (rtl_freq)
|
|
|
|
std::cerr << "Setting rtl clock to " << rtl_freq << " Hz." << std::endl;
|
|
|
|
if (tuner_freq)
|
|
|
|
std::cerr << "Setting tuner clock to " << tuner_freq << " Hz." << std::endl;
|
|
|
|
|
|
|
|
ret = rtlsdr_set_xtal_freq( _dev, rtl_freq, tuner_freq );
|
|
|
|
if (ret < 0)
|
|
|
|
throw std::runtime_error(
|
|
|
|
str(boost::format("Failed to set xtal frequencies. Error %d.") % ret ));
|
|
|
|
}
|
|
|
|
|
2012-04-11 21:37:02 +00:00
|
|
|
ret = rtlsdr_set_sample_rate( _dev, 1024000 );
|
2012-04-06 13:29:14 +00:00
|
|
|
if (ret < 0)
|
2012-04-11 21:37:02 +00:00
|
|
|
throw std::runtime_error("Failed to set default samplerate.");
|
2012-04-06 13:29:14 +00:00
|
|
|
|
2012-04-11 21:37:02 +00:00
|
|
|
ret = rtlsdr_reset_buffer( _dev );
|
2012-04-06 13:29:14 +00:00
|
|
|
if (ret < 0)
|
2012-04-11 21:37:02 +00:00
|
|
|
throw std::runtime_error("Failed to reset usb buffers.");
|
2012-04-06 13:29:14 +00:00
|
|
|
|
2012-04-11 21:37:02 +00:00
|
|
|
_running = true;
|
2012-04-06 13:29:14 +00:00
|
|
|
|
|
|
|
_thread = gruel::thread(_rtlsdr_wait, this);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Our virtual destructor.
|
|
|
|
*/
|
|
|
|
rtl_source_c::~rtl_source_c ()
|
|
|
|
{
|
|
|
|
if (_dev) {
|
|
|
|
rtlsdr_cancel_async( _dev );
|
|
|
|
_thread.join();
|
|
|
|
rtlsdr_close( _dev );
|
|
|
|
_dev = NULL;
|
|
|
|
}
|
2012-04-26 17:14:42 +00:00
|
|
|
|
|
|
|
for(unsigned int i = 0; i < _buf_num; ++i) {
|
|
|
|
if (_buf[i])
|
|
|
|
free(_buf[i]);
|
|
|
|
}
|
|
|
|
|
|
|
|
free(_buf);
|
|
|
|
_buf = NULL;
|
2012-04-06 13:29:14 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
void rtl_source_c::_rtlsdr_callback(unsigned char *buf, uint32_t len, void *ctx)
|
|
|
|
{
|
|
|
|
rtl_source_c *obj = (rtl_source_c *)ctx;
|
|
|
|
obj->rtlsdr_callback(buf, len);
|
|
|
|
}
|
|
|
|
|
|
|
|
void rtl_source_c::rtlsdr_callback(unsigned char *buf, uint32_t len)
|
|
|
|
{
|
2012-04-26 17:14:42 +00:00
|
|
|
if (len != BUF_SIZE) {
|
|
|
|
printf("U(%d)\n", len); fflush(stdout);
|
|
|
|
return;
|
|
|
|
}
|
2012-04-06 16:52:26 +00:00
|
|
|
|
2012-04-26 17:14:42 +00:00
|
|
|
{
|
|
|
|
boost::mutex::scoped_lock lock( _buf_mutex );
|
2012-04-11 21:37:02 +00:00
|
|
|
|
2012-04-26 17:14:42 +00:00
|
|
|
int buf_tail = (_buf_head + _buf_used) % _buf_num;
|
|
|
|
memcpy(_buf[buf_tail], buf, len);
|
2012-04-06 16:52:26 +00:00
|
|
|
|
2012-04-26 17:14:42 +00:00
|
|
|
if (_buf_used == _buf_num) {
|
2012-04-06 16:52:26 +00:00
|
|
|
printf("O"); fflush(stdout);
|
2012-04-26 17:14:42 +00:00
|
|
|
_buf_head = (_buf_head + 1) % _buf_num;
|
|
|
|
} else {
|
|
|
|
_buf_used++;
|
2012-04-06 13:29:14 +00:00
|
|
|
}
|
2012-04-06 16:52:26 +00:00
|
|
|
}
|
2012-04-11 21:37:02 +00:00
|
|
|
|
|
|
|
_buf_cond.notify_one();
|
2012-04-06 13:29:14 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
void rtl_source_c::_rtlsdr_wait(rtl_source_c *obj)
|
|
|
|
{
|
|
|
|
obj->rtlsdr_wait();
|
|
|
|
}
|
|
|
|
|
|
|
|
void rtl_source_c::rtlsdr_wait()
|
|
|
|
{
|
2012-04-26 17:14:42 +00:00
|
|
|
int ret = rtlsdr_read_async( _dev, _rtlsdr_callback, (void *)this, 0, BUF_SIZE );
|
2012-04-06 13:29:14 +00:00
|
|
|
|
2012-04-11 21:37:02 +00:00
|
|
|
_running = false;
|
|
|
|
|
|
|
|
if ( ret != 0 )
|
|
|
|
std::cerr << "rtlsdr_read_async returned with " << ret << std::endl;
|
2012-04-06 13:29:14 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
int rtl_source_c::work( int noutput_items,
|
|
|
|
gr_vector_const_void_star &input_items,
|
|
|
|
gr_vector_void_star &output_items )
|
|
|
|
{
|
2012-04-06 16:52:26 +00:00
|
|
|
gr_complex *out = (gr_complex *)output_items[0];
|
2012-04-06 13:29:14 +00:00
|
|
|
|
2012-04-26 17:14:42 +00:00
|
|
|
{
|
|
|
|
boost::mutex::scoped_lock lock( _buf_mutex );
|
|
|
|
|
|
|
|
while (_buf_used < 3 && _running)
|
|
|
|
_buf_cond.wait( lock );
|
|
|
|
}
|
|
|
|
|
2012-04-11 21:37:02 +00:00
|
|
|
if (!_running)
|
|
|
|
return WORK_DONE;
|
|
|
|
|
2012-04-26 17:14:42 +00:00
|
|
|
unsigned short *buf = _buf[_buf_head];
|
2012-04-06 13:29:14 +00:00
|
|
|
|
2012-04-26 17:14:42 +00:00
|
|
|
if (noutput_items <= int(_samp_avail)) {
|
|
|
|
for (int i = 0; i <= noutput_items; ++i)
|
|
|
|
*out++ = _lut[ *(buf + _buf_offset + i) ];
|
2012-04-06 13:29:14 +00:00
|
|
|
|
2012-04-26 17:14:42 +00:00
|
|
|
_buf_offset += noutput_items;
|
|
|
|
_samp_avail -= noutput_items;
|
|
|
|
return noutput_items;
|
|
|
|
} else {
|
|
|
|
for (int i = 0; i <= int(_samp_avail); ++i)
|
|
|
|
*out++ = _lut[ *(buf + _buf_offset + i) ];
|
2012-04-06 13:29:14 +00:00
|
|
|
|
2012-04-06 16:52:26 +00:00
|
|
|
{
|
|
|
|
boost::mutex::scoped_lock lock( _buf_mutex );
|
2012-04-06 13:29:14 +00:00
|
|
|
|
2012-04-26 17:14:42 +00:00
|
|
|
_buf_head = (_buf_head + 1) % _buf_num;
|
|
|
|
_buf_used--;
|
2012-04-06 16:52:26 +00:00
|
|
|
}
|
2012-04-26 17:14:42 +00:00
|
|
|
|
|
|
|
buf = _buf[_buf_head];
|
|
|
|
_buf_offset = 0;
|
|
|
|
|
|
|
|
int remaining = noutput_items - _samp_avail;
|
|
|
|
|
|
|
|
for (int i = 0; i <= remaining; ++i)
|
|
|
|
*out++ = _lut[ *(buf + _buf_offset + i) ];
|
|
|
|
|
|
|
|
_buf_offset = remaining;
|
|
|
|
|
|
|
|
_samp_avail = (BUF_SIZE/2) - remaining;
|
|
|
|
|
|
|
|
return noutput_items;
|
2012-04-06 13:29:14 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
return noutput_items;
|
|
|
|
}
|
|
|
|
|
2012-04-11 21:37:02 +00:00
|
|
|
size_t rtl_source_c::get_num_channels()
|
|
|
|
{
|
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
osmosdr::meta_range_t rtl_source_c::get_sample_rates()
|
|
|
|
{
|
|
|
|
osmosdr::meta_range_t range;
|
|
|
|
|
2012-04-26 17:14:42 +00:00
|
|
|
range += osmosdr::range_t( 1024000 ); // known to work
|
|
|
|
range += osmosdr::range_t( 2048000 ); // known to work
|
|
|
|
range += osmosdr::range_t( 3200000 ); // max rate, may work
|
2012-04-11 21:37:02 +00:00
|
|
|
|
|
|
|
// TODO: read from the librtlsdr as soon as the api is available
|
|
|
|
|
|
|
|
return range;
|
|
|
|
}
|
|
|
|
|
|
|
|
double rtl_source_c::set_sample_rate(double rate)
|
2012-04-06 13:29:14 +00:00
|
|
|
{
|
|
|
|
if (_dev) {
|
2012-04-11 21:37:02 +00:00
|
|
|
rtlsdr_set_sample_rate( _dev, (uint32_t)rate );
|
2012-04-06 13:29:14 +00:00
|
|
|
}
|
|
|
|
|
2012-04-11 21:37:02 +00:00
|
|
|
return get_sample_rate();
|
2012-04-06 13:29:14 +00:00
|
|
|
}
|
|
|
|
|
2012-04-11 21:37:02 +00:00
|
|
|
double rtl_source_c::get_sample_rate()
|
2012-04-06 13:29:14 +00:00
|
|
|
{
|
2012-04-11 21:37:02 +00:00
|
|
|
if (_dev)
|
2012-04-06 13:29:14 +00:00
|
|
|
return (double)rtlsdr_get_sample_rate( _dev );
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2012-04-11 21:37:02 +00:00
|
|
|
osmosdr::freq_range_t rtl_source_c::get_freq_range( size_t chan )
|
|
|
|
{
|
|
|
|
osmosdr::freq_range_t range;
|
|
|
|
|
|
|
|
range += osmosdr::range_t( 50e6, 2.2e9, 100 );
|
|
|
|
|
|
|
|
// TODO: read from the librtlsdr as soon as the api is available
|
|
|
|
|
|
|
|
return range;
|
|
|
|
}
|
|
|
|
|
|
|
|
double rtl_source_c::set_center_freq( double freq, size_t chan )
|
2012-04-06 13:29:14 +00:00
|
|
|
{
|
|
|
|
if (_dev)
|
2012-04-11 21:37:02 +00:00
|
|
|
rtlsdr_set_center_freq( _dev, (uint32_t)freq );
|
|
|
|
|
|
|
|
return get_center_freq( chan );
|
|
|
|
}
|
|
|
|
|
|
|
|
double rtl_source_c::get_center_freq( size_t chan )
|
|
|
|
{
|
|
|
|
if (_dev)
|
|
|
|
return (double)rtlsdr_get_center_freq( _dev );
|
2012-04-06 13:29:14 +00:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2012-04-11 21:37:02 +00:00
|
|
|
double rtl_source_c::set_freq_corr( double ppm, size_t chan )
|
2012-04-06 13:29:14 +00:00
|
|
|
{
|
2012-04-11 21:37:02 +00:00
|
|
|
if ( _dev )
|
|
|
|
rtlsdr_set_freq_correction( _dev, (int)ppm );
|
|
|
|
|
|
|
|
return get_freq_corr( chan );
|
|
|
|
}
|
|
|
|
|
|
|
|
double rtl_source_c::get_freq_corr( size_t chan )
|
|
|
|
{
|
|
|
|
if ( _dev )
|
|
|
|
return (double)rtlsdr_get_freq_correction( _dev );
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
std::vector<std::string> rtl_source_c::get_gain_names( size_t chan )
|
|
|
|
{
|
|
|
|
std::vector< std::string > antennas;
|
|
|
|
|
|
|
|
antennas += "LNA";
|
|
|
|
|
|
|
|
return antennas;
|
|
|
|
}
|
|
|
|
|
|
|
|
osmosdr::gain_range_t rtl_source_c::get_gain_range( size_t chan )
|
|
|
|
{
|
|
|
|
osmosdr::gain_range_t range;
|
|
|
|
|
|
|
|
range += osmosdr::range_t( -5, 30, 2.5 );
|
|
|
|
|
|
|
|
// TODO: read from the librtlsdr as soon as the api is available
|
|
|
|
|
|
|
|
return range;
|
|
|
|
}
|
|
|
|
|
|
|
|
osmosdr::gain_range_t rtl_source_c::get_gain_range( const std::string & name, size_t chan )
|
|
|
|
{
|
|
|
|
return get_gain_range( chan );
|
|
|
|
}
|
|
|
|
|
|
|
|
double rtl_source_c::set_gain( double gain, size_t chan )
|
|
|
|
{
|
|
|
|
if (_dev)
|
|
|
|
rtlsdr_set_tuner_gain( _dev, gain );
|
|
|
|
|
|
|
|
return get_gain( chan );
|
|
|
|
}
|
|
|
|
|
|
|
|
double rtl_source_c::set_gain( double gain, const std::string & name, size_t chan)
|
|
|
|
{
|
|
|
|
return set_gain( gain, chan );
|
|
|
|
}
|
|
|
|
|
|
|
|
double rtl_source_c::get_gain( size_t chan )
|
|
|
|
{
|
|
|
|
if ( _dev )
|
2012-04-06 13:29:14 +00:00
|
|
|
return (double)rtlsdr_get_tuner_gain( _dev );
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
2012-04-11 21:37:02 +00:00
|
|
|
|
|
|
|
double rtl_source_c::get_gain( const std::string & name, size_t chan )
|
|
|
|
{
|
|
|
|
return get_gain( chan );
|
|
|
|
}
|
|
|
|
|
|
|
|
std::vector< std::string > rtl_source_c::get_antennas( size_t chan )
|
|
|
|
{
|
|
|
|
std::vector< std::string > antennas;
|
|
|
|
|
|
|
|
antennas += get_antenna( chan );
|
|
|
|
|
|
|
|
return antennas;
|
|
|
|
}
|
|
|
|
|
|
|
|
std::string rtl_source_c::set_antenna( const std::string & antenna, size_t chan )
|
|
|
|
{
|
|
|
|
return get_antenna( chan );
|
|
|
|
}
|
|
|
|
|
|
|
|
std::string rtl_source_c::get_antenna( size_t chan )
|
|
|
|
{
|
|
|
|
return "ANT";
|
|
|
|
}
|