//
// Copyright 2010 Ettus Research LLC
//
// 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 <uhd/usrp/mimo_usrp.hpp>
#include <uhd/usrp/tune_helper.hpp>
#include <uhd/utils/assert.hpp>
#include <uhd/usrp/subdev_props.hpp>
#include <uhd/usrp/mboard_props.hpp>
#include <uhd/usrp/device_props.hpp>
#include <uhd/usrp/dboard_props.hpp>
#include <uhd/usrp/dsp_props.hpp>
#include <boost/foreach.hpp>
#include <boost/format.hpp>
#include <stdexcept>

using namespace uhd;
using namespace uhd::usrp;

/***********************************************************************
 * MIMO USRP Implementation
 **********************************************************************/
class mimo_usrp_impl : public mimo_usrp{
public:
    mimo_usrp_impl(const device_addr_t &addr){
        _dev = device::make(addr);

        //extract each mboard and its sub-devices
        BOOST_FOREACH(const std::string &name, (*_dev)[DEVICE_PROP_MBOARD_NAMES].as<prop_names_t>()){
            _mboards.push_back((*_dev)[named_prop_t(DEVICE_PROP_MBOARD, name)]);
            _rx_dsps.push_back(_mboards.back()[MBOARD_PROP_RX_DSP]);
            _tx_dsps.push_back(_mboards.back()[MBOARD_PROP_TX_DSP]);

            //extract rx subdevice
            _rx_dboards.push_back(_mboards.back()[MBOARD_PROP_RX_DBOARD]);
            std::string rx_subdev_in_use = _rx_dboards.back()[DBOARD_PROP_USED_SUBDEVS].as<prop_names_t>().at(0);
            _rx_subdevs.push_back(_rx_dboards.back()[named_prop_t(DBOARD_PROP_SUBDEV, rx_subdev_in_use)]);

            //extract tx subdevice
            _tx_dboards.push_back(_mboards.back()[MBOARD_PROP_TX_DBOARD]);
            std::string tx_subdev_in_use = _tx_dboards.back()[DBOARD_PROP_USED_SUBDEVS].as<prop_names_t>().at(0);
            _tx_subdevs.push_back(_tx_dboards.back()[named_prop_t(DBOARD_PROP_SUBDEV, tx_subdev_in_use)]);
        }

        //set the clock config across all mboards (TODO set through api)
        clock_config_t clock_config;
        clock_config.ref_source = clock_config_t::REF_SMA;
        clock_config.pps_source = clock_config_t::PPS_SMA;
        BOOST_FOREACH(wax::obj mboard, _mboards){
            mboard[MBOARD_PROP_CLOCK_CONFIG] = clock_config;
        }

    }

    ~mimo_usrp_impl(void){
        /* NOP */
    }

    device::sptr get_device(void){
        return _dev;
    }

    std::string get_pp_string(void){
        std::string buff = str(boost::format(
            "MIMO USRP:\n"
            "  Device: %s\n"
        )
            % (*_dev)[DEVICE_PROP_NAME].as<std::string>()
        );
        for (size_t i = 0; i < get_num_channels(); i++){
            buff += str(boost::format(
                "  Channel: %u\n"
                "    Mboard: %s\n"
                "    RX DSP: %s\n"
                "    RX Dboard: %s\n"
                "    RX Subdev: %s\n"
                "    TX DSP: %s\n"
                "    TX Dboard: %s\n"
                "    TX Subdev: %s\n"
            ) % i
                % _mboards.at(i)[MBOARD_PROP_NAME].as<std::string>()
                % _rx_dsps.at(i)[DSP_PROP_NAME].as<std::string>()
                % _rx_dboards.at(i)[DBOARD_PROP_NAME].as<std::string>()
                % _rx_subdevs.at(i)[SUBDEV_PROP_NAME].as<std::string>()
                % _tx_dsps.at(i)[DSP_PROP_NAME].as<std::string>()
                % _tx_dboards.at(i)[DBOARD_PROP_NAME].as<std::string>()
                % _tx_subdevs.at(i)[SUBDEV_PROP_NAME].as<std::string>()
            );
        }
        return buff;
    }

    size_t get_num_channels(void){
        return _mboards.size();
    }

    /*******************************************************************
     * Misc
     ******************************************************************/
    void set_time_next_pps(const time_spec_t &time_spec){
        BOOST_FOREACH(wax::obj mboard, _mboards){
            mboard[MBOARD_PROP_TIME_NEXT_PPS] = time_spec;
        }
    }

    void issue_stream_cmd(const stream_cmd_t &stream_cmd){
        BOOST_FOREACH(wax::obj mboard, _mboards){
            mboard[MBOARD_PROP_STREAM_CMD] = stream_cmd;
        }
    }

    /*******************************************************************
     * RX methods
     ******************************************************************/

    /*******************************************************************
     * TX methods
     ******************************************************************/

private:
    device::sptr _dev;
    std::vector<wax::obj> _mboards;
    std::vector<wax::obj> _rx_dsps;
    std::vector<wax::obj> _tx_dsps;
    std::vector<wax::obj> _rx_dboards;
    std::vector<wax::obj> _tx_dboards;
    std::vector<wax::obj> _rx_subdevs;
    std::vector<wax::obj> _tx_subdevs;
};

/***********************************************************************
 * The Make Function
 **********************************************************************/
mimo_usrp::sptr mimo_usrp::make(const device_addr_t &dev_addr){
    return sptr(new mimo_usrp_impl(dev_addr));
}