/* -*- 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.
 */

#include <boost/assign.hpp>
#include <boost/algorithm/string.hpp>

//#include <uhd/property_tree.hpp>

#include "arg_helpers.h"

#include "uhd_sink_c.h"

using namespace boost::assign;

uhd_sink_c_sptr make_uhd_sink_c(const std::string &args)
{
  return gnuradio::get_initial_sptr(new uhd_sink_c(args));
}

static size_t parse_nchan(const std::string &args)
{
  size_t nchan = 1;

  dict_t dict = params_to_dict(args);

  if (dict.count("nchan"))
    nchan = boost::lexical_cast< size_t >( dict["nchan"] );

  return nchan;
}

uhd_sink_c::uhd_sink_c(const std::string &args) :
    gr::hier_block2("uhd_sink_c",
                   gr::io_signature::make(parse_nchan(args),
                                          parse_nchan(args),
                                          sizeof(gr_complex)),
                   gr::io_signature::make(0, 0, 0)),
    _center_freq(0.0f),
    _freq_corr(0.0f),
    _lo_offset(0.0f)
{
  size_t nchan = 1;
  dict_t dict = params_to_dict(args);
  uhd::stream_args_t stream_args;

  if (dict.count("nchan"))
    nchan = boost::lexical_cast< size_t >( dict["nchan"] );

  if (0 == nchan)
    nchan = 1;

  if (dict.count("lo_offset"))
    _lo_offset = boost::lexical_cast< double >( dict["lo_offset"] );

  std::string arguments; // rebuild argument string without internal arguments
  for (dict_t::value_type &entry : dict)
  {
    if ( "cpu_format" == entry.first ||
         "otw_format" == entry.first ||
         "fullscale" == entry.first ||
         "peak" == entry.first ||
         "nchan" == entry.first ||
         "subdev" == entry.first ||
         "lo_offset" == entry.first ||
         "uhd" == entry.first )
      continue;

    arguments += entry.first + "=" + entry.second + ",";
  }

  stream_args.cpu_format = "fc32";
  stream_args.otw_format = "sc16";

  if (dict.count("cpu_format") )
    stream_args.cpu_format = dict["cpu_format"];

  if (dict.count("otw_format") )
    stream_args.otw_format = dict["otw_format"];

  for (size_t chan = 0; chan < nchan; chan++)
    stream_args.channels.push_back(chan); // linear mapping

  if (dict.count("peak") )
    stream_args.args["peak"] = dict["peak"];

  if (dict.count("fullscale") )
    stream_args.args["fullscale"] = dict["fullscale"];

  _snk = gr::uhd::usrp_sink::make( arguments, stream_args );

  if (dict.count("subdev"))
    _snk->set_subdev_spec( dict["subdev"] );

  std::cerr << "-- Using subdev spec '" << _snk->get_subdev_spec() << "'."
            << std::endl;

  if (0.0 != _lo_offset)
    std::cerr << "-- Using LO offset of " << _lo_offset << " Hz." << std::endl;
#if 0
  std::vector<int> sizes = _snk->input_signature()->sizeof_stream_items();

  while ( sizes.size() > nchan )
    sizes.erase( sizes.end() );
  // TODO: setting the input signature is broken for hier blocks (gnuradio bug #719)
  set_input_signature( gr::io_signature::makev( nchan, nchan, sizes ) );
#endif
  for ( size_t i = 0; i < nchan; i++ )
    connect( self(), i, _snk, i );
}

uhd_sink_c::~uhd_sink_c()
{
}

std::vector< std::string > uhd_sink_c::get_devices()
{
  std::vector< std::string > devices;

  uhd::device_addr_t hint;
  for (const uhd::device_addr_t &dev : uhd::device::find(hint))
  {
    std::string args = "uhd," + dev.to_string();

    std::string type = dev.cast< std::string >("type", "usrp");
    std::string name = dev.cast< std::string >("name", "");
    std::string serial = dev.cast< std::string >("serial", "");

    std::string label = "Ettus";

    if ( "umtrx" == type )
      label = "Fairwaves";

    if (type.length()) {
      boost::to_upper(type);
      label += " " + type;
    }

    if (name.length())
      label += " (" + name + ")";

    if (serial.length())
      label += " " + serial;

    args += ",label='" + label +  + "'";

    devices.push_back( args );
  }

  return devices;
}

std::string uhd_sink_c::name()
{
//  uhd::property_tree::sptr prop_tree = _snk->get_device()->get_device()->get_tree();
//  std::string dev_name = prop_tree->access<std::string>("/name").get();
  std::string mboard_name = _snk->get_device()->get_mboard_name();

//  std::cerr << "'" << dev_name << "' '" << mboard_name << "'" << std::endl;
//  'USRP1 Device' 'USRP1 (Classic)'
//  'B-Series Device' 'B100 (B-Hundo)'

  return mboard_name;
}

size_t uhd_sink_c::get_num_channels()
{
//  return _snk->get_device()->get_rx_num_channels();
  return input_signature()->max_streams();
}

osmosdr::meta_range_t uhd_sink_c::get_sample_rates( void )
{
  osmosdr::meta_range_t rates;

  for (uhd::range_t rate : _snk->get_samp_rates())
      rates += osmosdr::range_t( rate.start(), rate.stop(), rate.step() );

  return rates;
}

double uhd_sink_c::set_sample_rate( double rate )
{
  _snk->set_samp_rate( rate );
  return get_sample_rate();
}

double uhd_sink_c::get_sample_rate( void )
{
  return _snk->get_samp_rate();
}

osmosdr::freq_range_t uhd_sink_c::get_freq_range( size_t chan )
{
  osmosdr::freq_range_t range;

  for (uhd::range_t freq : _snk->get_freq_range(chan))
      range += osmosdr::range_t( freq.start(), freq.stop(), freq.step() );

  return range;
}

double uhd_sink_c::set_center_freq( double freq, size_t chan )
{
  #define APPLY_PPM_CORR(val, ppm) ((val) * (1.0 + (ppm) * 0.000001))

  double corr_freq = APPLY_PPM_CORR( freq, _freq_corr );

  // advanced tuning with tune_request_t
  uhd::tune_request_t tune_req(corr_freq, _lo_offset);
  _snk->set_center_freq(tune_req, chan);

  _center_freq = freq;

  return get_center_freq(chan);
}

double uhd_sink_c::get_center_freq( size_t chan )
{
  return _snk->get_center_freq(chan);
}

double uhd_sink_c::set_freq_corr( double ppm, size_t chan )
{
  _freq_corr = ppm;

  set_center_freq( _center_freq );

  return get_freq_corr(chan);
}

double uhd_sink_c::get_freq_corr( size_t chan )
{
  return _freq_corr;
}

std::vector<std::string> uhd_sink_c::get_gain_names( size_t chan )
{
  return _snk->get_gain_names( chan );
}

osmosdr::gain_range_t uhd_sink_c::get_gain_range( size_t chan )
{
  osmosdr::gain_range_t range;

  for (uhd::range_t gain : _snk->get_gain_range(chan))
      range += osmosdr::range_t( gain.start(), gain.stop(), gain.step() );

  return range;
}

osmosdr::gain_range_t uhd_sink_c::get_gain_range( const std::string & name, size_t chan )
{
  osmosdr::gain_range_t range;

  for (uhd::range_t gain : _snk->get_gain_range(name, chan))
      range += osmosdr::range_t( gain.start(), gain.stop(), gain.step() );

  return range;
}

double uhd_sink_c::set_gain( double gain, size_t chan )
{
  _snk->set_gain(gain, chan);

  return get_gain(chan);
}

double uhd_sink_c::set_gain( double gain, const std::string & name, size_t chan )
{
  _snk->set_gain(gain, name, chan);

  return get_gain(name, chan);
}

double uhd_sink_c::get_gain( size_t chan )
{
  return _snk->get_gain(chan);
}

double uhd_sink_c::get_gain( const std::string & name, size_t chan )
{
  return _snk->get_gain(name, chan);
}

std::vector< std::string > uhd_sink_c::get_antennas( size_t chan )
{
  return _snk->get_antennas(chan);
}

std::string uhd_sink_c::set_antenna( const std::string & antenna, size_t chan )
{
  _snk->set_antenna(antenna, chan);

  return _snk->get_antenna(chan);
}

std::string uhd_sink_c::get_antenna( size_t chan )
{
  return _snk->get_antenna(chan);
}

void uhd_sink_c::set_dc_offset( const std::complex<double> &offset, size_t chan )
{
  try {
    _snk->set_dc_offset( offset, chan );
  } catch ( const std::exception &ex ) {
    std::cerr << __FUNCTION__ << ": " << ex.what() << std::endl;
  }
}

void uhd_sink_c::set_iq_balance( const std::complex<double> &balance, size_t chan )
{
  try {
    _snk->set_iq_balance( balance, chan );
  } catch ( const std::exception &ex ) {
    std::cerr << __FUNCTION__ << ": " << ex.what() << std::endl;
  }
}

double uhd_sink_c::set_bandwidth( double bandwidth, size_t chan )
{
  _snk->set_bandwidth(bandwidth, chan);

  return _snk->get_bandwidth(chan);
}

double uhd_sink_c::get_bandwidth( size_t chan )
{
  return _snk->get_bandwidth(chan);
}

osmosdr::freq_range_t uhd_sink_c::get_bandwidth_range( size_t chan )
{
  osmosdr::freq_range_t bandwidths;

  for (uhd::range_t bw : _snk->get_bandwidth_range(chan))
      bandwidths += osmosdr::range_t( bw.start(), bw.stop(), bw.step() );

  return bandwidths;
}

void uhd_sink_c::set_time_source(const std::string &source, const size_t mboard)
{
  _snk->set_time_source( source, mboard );
}

std::string uhd_sink_c::get_time_source(const size_t mboard)
{
  return _snk->get_time_source( mboard );
}

std::vector<std::string> uhd_sink_c::get_time_sources(const size_t mboard)
{
  return _snk->get_time_sources( mboard );
}

void uhd_sink_c::set_clock_source(const std::string &source, const size_t mboard)
{
  _snk->set_clock_source( source,  mboard );
}

std::string uhd_sink_c::get_clock_source(const size_t mboard)
{
  return _snk->get_clock_source( mboard );
}

std::vector<std::string> uhd_sink_c::get_clock_sources(const size_t mboard)
{
  return _snk->get_clock_sources( mboard );
}

double uhd_sink_c::get_clock_rate(size_t mboard)
{
  return _snk->get_clock_rate( mboard );
}

void uhd_sink_c::set_clock_rate(double rate, size_t mboard)
{
  _snk->set_clock_rate( rate, mboard );
}

osmosdr::time_spec_t uhd_sink_c::get_time_now(size_t mboard)
{
  uhd::time_spec_t ts = _snk->get_time_now( mboard );
  return osmosdr::time_spec_t( ts.get_full_secs(), ts.get_frac_secs() );
}

osmosdr::time_spec_t uhd_sink_c::get_time_last_pps(size_t mboard)
{
  uhd::time_spec_t ts = _snk->get_time_last_pps( mboard );
  return osmosdr::time_spec_t( ts.get_full_secs(), ts.get_frac_secs() );
}

void uhd_sink_c::set_time_now(const osmosdr::time_spec_t &time_spec, size_t mboard)
{
  _snk->set_time_now( uhd::time_spec_t( time_spec.get_full_secs(), time_spec.get_frac_secs() ), mboard );
}

void uhd_sink_c::set_time_next_pps(const osmosdr::time_spec_t &time_spec)
{
  _snk->set_time_next_pps( uhd::time_spec_t( time_spec.get_full_secs(), time_spec.get_frac_secs() ) );
}

void uhd_sink_c::set_time_unknown_pps(const osmosdr::time_spec_t &time_spec)
{
  _snk->set_time_unknown_pps( uhd::time_spec_t( time_spec.get_full_secs(), time_spec.get_frac_secs() ) );
}