/* -*- c++ -*- */
/*
 * Copyright 2010 Free Software Foundation, Inc.
 * 
 * This file is part of GNU Radio
 * 
 * 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 <uhd_mimo_source.h>
#include <gr_io_signature.h>
#include <stdexcept>
//#include "utils.h"

/***********************************************************************
 * UHD Source
 **********************************************************************/
uhd_mimo_source::uhd_mimo_source(gr_io_signature_sptr sig)
:gr_sync_block("uhd mimo source", gr_make_io_signature(0, 0, 0), sig){
    /* NOP */
}

/***********************************************************************
 * UHD Source Impl
 **********************************************************************/
class uhd_mimo_source_impl : public uhd_mimo_source{
public:
    uhd_mimo_source_impl(
        size_t num_channels,
        const std::string &args,
        const uhd::io_type_t &type
    ) : uhd_mimo_source(gr_make_io_signature(num_channels, num_channels, type.size)), _type(type)
    {
        _dev = uhd::usrp::mimo_usrp::make(args);
        set_streaming(false);
        _dev->set_time_unknown_pps(uhd::time_spec_t()); //TODO may want option to disable this
    }

    ~uhd_mimo_source_impl(void){
        set_streaming(false);
    }

    void set_subdev_spec(size_t chan, const std::string &spec){
        return _dev->set_rx_subdev_spec(chan, spec);
    }

    void set_samp_rate_all(double rate){
        _dev->set_rx_rate_all(rate);
        //do_samp_rate_error_message(rate, get_samp_rate_all(), "RX");
    }

    double get_samp_rate_all(void){
        return _dev->get_rx_rate_all();
    }

    uhd::tune_result_t set_center_freq(size_t chan, double freq){
        uhd::tune_result_t tr = _dev->set_rx_freq(chan, freq);
        //do_tune_freq_error_message(freq, _dev->get_rx_freq(chan), "RX");
        return tr;
    }

    uhd::freq_range_t get_freq_range(size_t chan){
        return _dev->get_rx_freq_range(chan);
    }

    void set_gain(size_t chan, float gain){
        return _dev->set_rx_gain(chan, gain);
    }

    float get_gain(size_t chan){
        return _dev->get_rx_gain(chan);
    }

    uhd::gain_range_t get_gain_range(size_t chan){
        return _dev->get_rx_gain_range(chan);
    }

    void set_antenna(size_t chan, const std::string &ant){
        return _dev->set_rx_antenna(chan, ant);
    }

    std::string get_antenna(size_t chan){
        return _dev->get_rx_antenna(chan);
    }

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

    uhd::time_spec_t get_time_now(void){
        return _dev->get_time_now();
    }

    void set_time_next_pps(const uhd::time_spec_t &time_spec){
        return _dev->set_time_next_pps(time_spec);
    }

    uhd::usrp::mimo_usrp::sptr get_device(void){
        return _dev;
    }

/***********************************************************************
 * Work
 **********************************************************************/
    int work(
        int noutput_items,
        gr_vector_const_void_star &input_items,
        gr_vector_void_star &output_items
    ){
        //conditionally start streaming in the work call
        //this prevents streaming before the runtime is ready
        if (not _is_streaming) set_streaming(true);

        uhd::rx_metadata_t metadata; //not passed out of this block

        return _dev->get_device()->recv(
            output_items, noutput_items, metadata,
            _type, uhd::device::RECV_MODE_FULL_BUFF
        );
    }

protected:
    uhd::usrp::mimo_usrp::sptr _dev;
    const uhd::io_type_t _type;
    bool _is_streaming;

    void set_streaming(bool enb){
        if (enb){
            //setup a stream command that starts streaming slightly in the future
            static const double reasonable_delay = 0.01; //10 ms (order of magnitude >> RTT)
            uhd::stream_cmd_t stream_cmd(uhd::stream_cmd_t::STREAM_MODE_START_CONTINUOUS);
            stream_cmd.stream_now = false;
            stream_cmd.time_spec = get_time_now() + uhd::time_spec_t(_dev->get_num_channels() * reasonable_delay);
            _dev->issue_stream_cmd(stream_cmd);
        }
        else
            _dev->issue_stream_cmd(uhd::stream_cmd_t::STREAM_MODE_STOP_CONTINUOUS);
        _is_streaming = enb;
    }
};

/***********************************************************************
 * Make UHD Source
 **********************************************************************/
boost::shared_ptr<uhd_mimo_source> uhd_make_mimo_source(
    size_t num_channels,
    const std::string &args,
    const uhd::io_type_t::tid_t &type
){
    return boost::shared_ptr<uhd_mimo_source>(
        new uhd_mimo_source_impl(num_channels, args, type)
    );
}