diff options
Diffstat (limited to 'host/lib')
| -rw-r--r-- | host/lib/usrp/b200/b200_impl.cpp | 9 | ||||
| -rw-r--r-- | host/lib/usrp/common/ad9361_ctrl.cpp | 34 | ||||
| -rw-r--r-- | host/lib/usrp/common/ad9361_ctrl.hpp | 18 | ||||
| -rw-r--r-- | host/lib/usrp/common/ad9361_driver/ad9361_device.cpp | 629 | ||||
| -rw-r--r-- | host/lib/usrp/common/ad9361_driver/ad9361_device.h | 91 | 
5 files changed, 723 insertions, 58 deletions
| diff --git a/host/lib/usrp/b200/b200_impl.cpp b/host/lib/usrp/b200/b200_impl.cpp index e0a5e2c2b..81bbb6691 100644 --- a/host/lib/usrp/b200/b200_impl.cpp +++ b/host/lib/usrp/b200/b200_impl.cpp @@ -738,6 +738,15 @@ void b200_impl::setup_radio(const size_t dspno)                  .subscribe(boost::bind(&ad9361_ctrl::set_iq_balance_auto, _codec_ctrl, key, _1)).set(true);          } +        //add all frontend filters +        std::vector<std::string> filter_names = _codec_ctrl->get_filter_names(key); +        for(size_t i = 0;i < filter_names.size(); i++) +        { +            _tree->create<filter_info_base::sptr>(rf_fe_path / "filters" / filter_names[i] / "value" ) +                .publish(boost::bind(&ad9361_ctrl::get_filter, _codec_ctrl, key, filter_names[i])) +                .subscribe(boost::bind(&ad9361_ctrl::set_filter, _codec_ctrl, key, filter_names[i], _1)); +        } +          //setup antenna stuff          if (key[0] == 'R')          { diff --git a/host/lib/usrp/common/ad9361_ctrl.cpp b/host/lib/usrp/common/ad9361_ctrl.cpp index a0a5fa663..9c17a582d 100644 --- a/host/lib/usrp/common/ad9361_ctrl.cpp +++ b/host/lib/usrp/common/ad9361_ctrl.cpp @@ -214,6 +214,40 @@ public:          _device.set_iq_balance_auto(direction,on);      } +    double set_bw_filter(const std::string &which, const double bw) +    { +        boost::lock_guard<boost::mutex> lock(_mutex); + +        ad9361_device_t::direction_t direction = _get_direction_from_antenna(which); +        return _device.set_bw_filter(direction, bw); +    } + +    std::vector<std::string> get_filter_names(const std::string &which) +    { +        boost::lock_guard<boost::mutex> lock(_mutex); + +        ad9361_device_t::direction_t direction = _get_direction_from_antenna(which); +        return _device.get_filter_names(direction); +    } + +    filter_info_base::sptr get_filter(const std::string &which, const std::string &filter_name) +    { +        boost::lock_guard<boost::mutex> lock(_mutex); + +        ad9361_device_t::direction_t direction = _get_direction_from_antenna(which); +        ad9361_device_t::chain_t chain =_get_chain_from_antenna(which); +        return _device.get_filter(direction, chain, filter_name); +    } + +    void set_filter(const std::string &which, const std::string &filter_name, const filter_info_base::sptr filter) +    { +        boost::lock_guard<boost::mutex> lock(_mutex); + +        ad9361_device_t::direction_t direction = _get_direction_from_antenna(which); +        ad9361_device_t::chain_t chain = _get_chain_from_antenna(which); +        _device.set_filter(direction, chain, filter_name, filter); +    } +  private:      static ad9361_device_t::direction_t _get_direction_from_antenna(const std::string& antenna)      { diff --git a/host/lib/usrp/common/ad9361_ctrl.hpp b/host/lib/usrp/common/ad9361_ctrl.hpp index 0dd1b08d9..a6d65ad11 100644 --- a/host/lib/usrp/common/ad9361_ctrl.hpp +++ b/host/lib/usrp/common/ad9361_ctrl.hpp @@ -27,6 +27,8 @@  #include <ad9361_device.h>  #include <string>  #include <complex> +#include <uhd/types/filters.hpp> +#include <vector>  namespace uhd { namespace usrp { @@ -79,11 +81,8 @@ public:          return uhd::meta_range_t(5e6, ad9361_device_t::AD9361_MAX_CLOCK_RATE); //5 MHz DCM low end      } -    //! set the filter bandwidth for the frontend -    double set_bw_filter(const std::string &/*which*/, const double /*bw*/) -    { -        return 56e6; //TODO -    } +    //! set the filter bandwidth for the frontend's analog low pass +    virtual double set_bw_filter(const std::string &/*which*/, const double /*bw*/) = 0;      //! set the gain for a particular gain element      virtual double set_gain(const std::string &which, const double value) = 0; @@ -131,6 +130,15 @@ public:      //! read the internal temp sensor      virtual sensor_value_t get_temperature() = 0; + +    //! List all available filters by name +    virtual std::vector<std::string> get_filter_names(const std::string &which) = 0; + +    //! Return a list of all filters +    virtual filter_info_base::sptr get_filter(const std::string &which, const std::string &filter_name) = 0; + +    //! Write back a filter +    virtual void set_filter(const std::string &which, const std::string &filter_name, const filter_info_base::sptr) = 0;  };  }} diff --git a/host/lib/usrp/common/ad9361_driver/ad9361_device.cpp b/host/lib/usrp/common/ad9361_driver/ad9361_device.cpp index 92ad0ee3f..c3eb5fb9d 100644 --- a/host/lib/usrp/common/ad9361_driver/ad9361_device.cpp +++ b/host/lib/usrp/common/ad9361_driver/ad9361_device.cpp @@ -88,7 +88,7 @@ const double ad9361_device_t::AD9361_CAL_VALID_WINDOW = 100e6;   * how many taps are in the filter, and given a vector of the taps   * themselves.  */ -void ad9361_device_t::_program_fir_filter(direction_t direction, int num_taps, boost::uint16_t *coeffs) +void ad9361_device_t::_program_fir_filter(direction_t direction, chain_t chain, int num_taps, boost::uint16_t *coeffs)  {      boost::uint16_t base; @@ -103,8 +103,20 @@ void ad9361_device_t::_program_fir_filter(direction_t direction, int num_taps, b      /* Encode number of filter taps for programming register */      boost::uint8_t reg_numtaps = (((num_taps / 16) - 1) & 0x07) << 5; +    boost::uint8_t reg_chain = 0; +    switch (chain) { +    case CHAIN_1: +        reg_chain = 0x01 << 3; +        break; +    case CHAIN_2: +        reg_chain = 0x02 << 3; +        break; +    default: +        reg_chain = 0x03 << 3; +    } +      /* Turn on the filter clock. */ -    _io_iface->poke8(base + 5, reg_numtaps | 0x1a); +    _io_iface->poke8(base + 5, reg_numtaps | reg_chain | 0x02);      boost::this_thread::sleep(boost::posix_time::milliseconds(1));      /* Zero the unused taps just in case they have stale data */ @@ -113,7 +125,7 @@ void ad9361_device_t::_program_fir_filter(direction_t direction, int num_taps, b          _io_iface->poke8(base + 0, addr);          _io_iface->poke8(base + 1, 0x0);          _io_iface->poke8(base + 2, 0x0); -        _io_iface->poke8(base + 5, reg_numtaps | 0x1e); +        _io_iface->poke8(base + 5, reg_numtaps | reg_chain | (1 << 1) | (1 << 2));          _io_iface->poke8(base + 4, 0x00);          _io_iface->poke8(base + 4, 0x00);      } @@ -123,7 +135,7 @@ void ad9361_device_t::_program_fir_filter(direction_t direction, int num_taps, b          _io_iface->poke8(base + 0, addr);          _io_iface->poke8(base + 1, (coeffs[addr]) & 0xff);          _io_iface->poke8(base + 2, (coeffs[addr] >> 8) & 0xff); -        _io_iface->poke8(base + 5, reg_numtaps | 0x1e); +        _io_iface->poke8(base + 5, reg_numtaps | reg_chain | (1 << 1) | (1 << 2));          _io_iface->poke8(base + 4, 0x00);          _io_iface->poke8(base + 4, 0x00);      } @@ -134,9 +146,9 @@ void ad9361_device_t::_program_fir_filter(direction_t direction, int num_taps, b       before the clock stops. Wait 4 sample clock periods after setting D2 high while that data writes into the table"       */ -    _io_iface->poke8(base + 5, reg_numtaps | 0x1A); +    _io_iface->poke8(base + 5, reg_numtaps | reg_chain | (1 << 1));      if (direction == RX) { -        _io_iface->poke8(base + 5, reg_numtaps | 0x18); +        _io_iface->poke8(base + 5, reg_numtaps | reg_chain );          /* Rx Gain, set to prevent digital overflow/saturation in filters             0:+6dB, 1:0dB, 2:-6dB, 3:-12dB             page 35 of UG-671 */ @@ -145,7 +157,7 @@ void ad9361_device_t::_program_fir_filter(direction_t direction, int num_taps, b          /* Tx Gain. bit[0]. set to prevent digital overflow/saturation in filters             0: 0dB, 1:-6dB             page 25 of UG-671 */ -        _io_iface->poke8(base + 5, reg_numtaps | 0x18); +        _io_iface->poke8(base + 5, reg_numtaps | reg_chain );      }  } @@ -176,7 +188,7 @@ void ad9361_device_t::_setup_rx_fir(size_t num_taps, boost::int32_t decimation)          }      } -    _program_fir_filter(RX, num_taps, coeffs.get()); +    _program_fir_filter(RX, CHAIN_BOTH, num_taps, coeffs.get());  }  /* Program the TX FIR Filter. */ @@ -208,7 +220,7 @@ void ad9361_device_t::_setup_tx_fir(size_t num_taps, boost::int32_t interpolatio          }      } -    _program_fir_filter(TX, num_taps, coeffs.get()); +    _program_fir_filter(TX, CHAIN_BOTH, num_taps, coeffs.get());  }  /*********************************************************************** @@ -283,16 +295,24 @@ void ad9361_device_t::_calibrate_synth_charge_pumps()   *   * Note that the filter calibration depends heavily on the baseband   * bandwidth, so this must be re-done after any change to the RX sample - * rate. */ -double ad9361_device_t::_calibrate_baseband_rx_analog_filter() + * rate. + * UG570 Page 33 states that this filter should be calibrated to 1.4 * bbbw*/ +double ad9361_device_t::_calibrate_baseband_rx_analog_filter(double req_rfbw)  { -    /* For filter tuning, baseband BW is half the complex BW, and must be -     * between 28e6 and 0.2e6. */ -    double bbbw = _baseband_bw / 2.0; +    double bbbw = req_rfbw / 2.0; +    if(bbbw > _baseband_bw / 2.0) +    { +        UHD_LOG << "baseband bandwidth too large for current sample rate. Setting bandwidth to: "<<_baseband_bw; +        bbbw = _baseband_bw / 2.0; +    } + +    /* Baseband BW must be between 28e6 and 0.143e6. +     * Max filter BW is 39.2 MHz. 39.2 / 1.4 = 28 +     * Min filter BW is 200kHz. 200 / 1.4 = 143 */      if (bbbw > 28e6) {          bbbw = 28e6; -    } else if (bbbw < 0.20e6) { -        bbbw = 0.20e6; +    } else if (bbbw < 0.143e6) { +        bbbw = 0.143e6;      }      double rxtune_clk = ((1.4 * bbbw * 2 * M_PI) / M_LN2); @@ -341,16 +361,25 @@ double ad9361_device_t::_calibrate_baseband_rx_analog_filter()   *   * Note that the filter calibration depends heavily on the baseband   * bandwidth, so this must be re-done after any change to the TX sample - * rate. */ -double ad9361_device_t::_calibrate_baseband_tx_analog_filter() + * rate. + * UG570 Page 32 states that this filter should be calibrated to 1.6 * bbbw*/ +double ad9361_device_t::_calibrate_baseband_tx_analog_filter(double req_rfbw)  { -    /* For filter tuning, baseband BW is half the complex BW, and must be -     * between 28e6 and 0.2e6. */ -    double bbbw = _baseband_bw / 2.0; +    double bbbw = req_rfbw / 2.0; + +    if(bbbw > _baseband_bw / 2.0) +    { +        UHD_LOG << "baseband bandwidth too large for current sample rate. Setting bandwidth to: "<<_baseband_bw; +        bbbw = _baseband_bw / 2.0; +    } + +    /* Baseband BW must be between 20e6 and 0.391e6. +     * Max filter BW is 32 MHz. 32 / 1.6 = 20 +     * Min filter BW is 625 kHz. 625 / 1.6 = 391 */      if (bbbw > 20e6) {          bbbw = 20e6; -    } else if (bbbw < 0.625e6) { -        bbbw = 0.625e6; +    } else if (bbbw < 0.391e6) { +        bbbw = 0.391e6;      }      double txtune_clk = ((1.6 * bbbw * 2 * M_PI) / M_LN2); @@ -387,16 +416,25 @@ double ad9361_device_t::_calibrate_baseband_tx_analog_filter()  /* Calibrate the secondary TX filter.   *   * This filter also depends on the TX sample rate, so if a rate change is - * made, the previous calibration will no longer be valid. */ -void ad9361_device_t::_calibrate_secondary_tx_filter() + * made, the previous calibration will no longer be valid. + * UG570 Page 32 states that this filter should be calibrated to 5 * bbbw*/ +double ad9361_device_t::_calibrate_secondary_tx_filter(double req_rfbw)  { -    /* For filter tuning, baseband BW is half the complex BW, and must be -     * between 20e6 and 0.53e6. */ -    double bbbw = _baseband_bw / 2.0; +    double bbbw = req_rfbw / 2.0; + +    if(bbbw > _baseband_bw / 2.0) +    { +        UHD_LOG << "baseband bandwidth too large for current sample rate. Setting bandwidth to: "<<_baseband_bw; +        bbbw = _baseband_bw / 2.0; +    } + +    /* Baseband BW must be between 20e6 and 0.54e6. +     * Max filter BW is 100 MHz. 100 / 5 = 20 +     * Min filter BW is 2.7 MHz. 2.7 / 5 = 0.54 */      if (bbbw > 20e6) {          bbbw = 20e6; -    } else if (bbbw < 0.53e6) { -        bbbw = 0.53e6; +    } else if (bbbw < 0.54e6) { +        bbbw = 0.54e6;      }      double bbbw_mhz = bbbw / 1e6; @@ -457,13 +495,17 @@ void ad9361_device_t::_calibrate_secondary_tx_filter()      _io_iface->poke8(0x0d2, reg0d2);      _io_iface->poke8(0x0d1, reg0d1);      _io_iface->poke8(0x0d0, reg0d0); + +    return bbbw;  }  /* Calibrate the RX TIAs.   *   * Note that the values in the TIA register, after calibration, vary with - * the RX gain settings. */ -void ad9361_device_t::_calibrate_rx_TIAs() + * the RX gain settings. + * We do not really program the BW here. Most settings are taken form the BB LPF registers + * UG570 page 33 states that this filter should be calibrated to 2.5 * bbbw */ +double ad9361_device_t::_calibrate_rx_TIAs(double req_rfbw)  {      boost::uint8_t reg1eb = _io_iface->peek8(0x1eb) & 0x3F;      boost::uint8_t reg1ec = _io_iface->peek8(0x1ec) & 0x7F; @@ -474,13 +516,21 @@ void ad9361_device_t::_calibrate_rx_TIAs()      boost::uint8_t reg1de = 0x00;      boost::uint8_t reg1df = 0x00; -    /* For calibration, baseband BW is half the complex BW, and must be -     * between 28e6 and 0.2e6. */ -    double bbbw = _baseband_bw / 2.0; -    if (bbbw > 20e6) { -        bbbw = 20e6; -    } else if (bbbw < 0.20e6) { -        bbbw = 0.20e6; +    double bbbw = req_rfbw / 2.0; + +    if(bbbw > _baseband_bw / 2.0) +    { +        UHD_LOG << "baseband bandwidth too large for current sample rate. Setting bandwidth to: "<<_baseband_bw; +        bbbw = _baseband_bw / 2.0; +    } + +    /* Baseband BW must be between 28e6 and 0.4e6. +     * Max filter BW is 70 MHz. 70 / 2.5 = 28 +     * Min filter BW is 1 MHz. 1 / 2.5 =  0.4*/ +    if (bbbw > 28e6) { +        bbbw = 28e6; +    } else if (bbbw < 0.40e6) { +        bbbw = 0.40e6;      }      double ceil_bbbw_mhz = std::ceil(bbbw / 1e6); @@ -521,6 +571,8 @@ void ad9361_device_t::_calibrate_rx_TIAs()      _io_iface->poke8(0x1df, reg1df);      _io_iface->poke8(0x1dc, reg1dc);      _io_iface->poke8(0x1de, reg1de); + +    return bbbw;  }  /* Setup the AD9361 ADC. @@ -1457,6 +1509,12 @@ void ad9361_device_t::initialize()      _rx1_agc_enable = false;      _rx2_agc_enable = false;      _last_calibration_freq = -AD9361_CAL_VALID_WINDOW; +    _rx_analog_bw = 0; +    _tx_analog_bw = 0; +    _rx_tia_lp_bw = 0; +    _tx_sec_lp_bw = 0; +    _rx_bb_lp_bw = 0; +    _tx_bb_lp_bw = 0;      /* Reset the device. */      _io_iface->poke8(0x000, 0x01); @@ -1602,10 +1660,8 @@ void ad9361_device_t::initialize()      _program_gain_table();      _setup_gain_control(false); -    _calibrate_baseband_rx_analog_filter(); -    _calibrate_baseband_tx_analog_filter(); -    _calibrate_rx_TIAs(); -    _calibrate_secondary_tx_filter(); +    set_bw_filter(RX, _baseband_bw); +    set_bw_filter(TX, _baseband_bw);      _setup_adc(); @@ -1729,10 +1785,8 @@ double ad9361_device_t::set_clock_rate(const double req_rate)      _setup_gain_control(false);      _reprogram_gains(); -    _calibrate_baseband_rx_analog_filter(); -    _calibrate_baseband_tx_analog_filter(); -    _calibrate_rx_TIAs(); -    _calibrate_secondary_tx_filter(); +    set_bw_filter(RX, _baseband_bw); +    set_bw_filter(TX, _baseband_bw);      _setup_adc(); @@ -2198,4 +2252,485 @@ void ad9361_device_t::set_agc_mode(chain_t chain, gain_mode_t gain_mode)      }  } +std::vector<std::string> ad9361_device_t::get_filter_names(direction_t direction) +{ +    std::vector<std::string> ret; +    if(direction == RX) { +        for(std::map<std::string, filter_query_helper>::iterator it = _rx_filters.begin(); it != _rx_filters.end(); ++it) { +            ret.push_back(it->first); +        } +    } else if (direction == TX) +    { +        for(std::map<std::string, filter_query_helper>::iterator it = _tx_filters.begin(); it != _tx_filters.end(); ++it) { +            ret.push_back(it->first); +        } +    } +    return ret; +} + +filter_info_base::sptr ad9361_device_t::get_filter(direction_t direction, chain_t chain, const std::string &name) +{ +    if(direction == RX) { +        if (not _rx_filters[name].get) +        { +            throw uhd::runtime_error("ad9361_device_t::get_filter this filter can not be read."); +        } +        return _rx_filters[name].get(direction, chain); +    } else if (direction == TX) { +        if (not _tx_filters[name].get) +        { +            throw uhd::runtime_error("ad9361_device_t::get_filter this filter can not be read."); +        } +        return _tx_filters[name].get(direction, chain); +    } + +    throw uhd::runtime_error("ad9361_device_t::get_filter wrong direction parameter."); +} + +void ad9361_device_t::set_filter(direction_t direction, chain_t chain, const std::string &name, filter_info_base::sptr filter) +{ + +    if(direction == RX) { +        if(not _rx_filters[name].set) +        { +            throw uhd::runtime_error("ad9361_device_t::set_filter this filter can not be written."); +        } +        _rx_filters[name].set(direction, chain, filter); +    } else if (direction == TX) { +        if(not _tx_filters[name].set) +        { +            throw uhd::runtime_error("ad9361_device_t::set_filter this filter can not be written."); +        } +        _tx_filters[name].set(direction, chain, filter); +    } + +} + +double ad9361_device_t::set_bw_filter(direction_t direction, const double rf_bw) +{ +    //both low pass filters are programmed to the same bw. However, their cutoffs will differ. +    //Together they should create the requested bb bw. +    double set_analog_bb_bw = 0; +    if(direction == RX) +    { +        _rx_bb_lp_bw = _calibrate_baseband_rx_analog_filter(rf_bw); //returns bb bw +        _rx_tia_lp_bw = _calibrate_rx_TIAs(rf_bw); +        _rx_analog_bw = _rx_bb_lp_bw; +        set_analog_bb_bw = _rx_analog_bw; +    } else { +        _tx_bb_lp_bw = _calibrate_baseband_tx_analog_filter(rf_bw); //returns bb bw +        _tx_sec_lp_bw = _calibrate_secondary_tx_filter(rf_bw); +        _tx_analog_bw = _tx_bb_lp_bw; +        set_analog_bb_bw = _tx_analog_bw; +    } +    return (2.0 * set_analog_bb_bw); +} + +void ad9361_device_t::_set_fir_taps(direction_t direction, chain_t chain, const std::vector<boost::int16_t>& taps) +{ +    size_t num_taps = taps.size(); +    size_t num_taps_avail = _get_num_fir_taps(direction); +    if(num_taps == num_taps_avail) +    { +        boost::scoped_array<boost::uint16_t> coeffs(new boost::uint16_t[num_taps_avail]); +        for (size_t i = 0; i < num_taps_avail; i++) +        { +            coeffs[i] = boost::uint16_t(taps[i]); +        } +        _program_fir_filter(direction, chain, num_taps_avail, coeffs.get()); +    } else if(num_taps < num_taps_avail){ +        throw uhd::runtime_error("ad9361_device_t::_set_fir_taps not enough coefficients."); +    } else { +        throw uhd::runtime_error("ad9361_device_t::_set_fir_taps too many coefficients."); +    } +} + +size_t ad9361_device_t::_get_num_fir_taps(direction_t direction) +{ +    boost::uint8_t num = 0; +    if(direction == RX) +        num = _io_iface->peek8(0x0F5); +    else +        num = _io_iface->peek8(0x065); +    num = ((num >> 5) & 0x07); +    return ((num + 1) * 16); +} + +size_t ad9361_device_t::_get_fir_dec_int(direction_t direction) +{ +    boost::uint8_t dec_int = 0; +    if(direction == RX) +        dec_int = _io_iface->peek8(0x003); +    else +        dec_int = _io_iface->peek8(0x002); +    /* +     * 0 = dec/int by 1 and bypass filter +     * 1 = dec/int by 1 +     * 2 = dec/int by 2 +     * 3 = dec/int by 4 */ +    dec_int = (dec_int & 0x03); +    if(dec_int == 3) +    { +        return 4; +    } +    return dec_int; +} + +std::vector<boost::int16_t> ad9361_device_t::_get_fir_taps(direction_t direction, chain_t chain) +{ +    int base; +    size_t num_taps = _get_num_fir_taps(direction); +    boost::uint8_t config; +    boost::uint8_t reg_numtaps = (((num_taps / 16) - 1) & 0x07) << 5; +    config = reg_numtaps | 0x02; //start the programming clock + +    if(chain == CHAIN_1) +    { +        config = config | (1 << 3); +    } else if (chain == CHAIN_2){ +        config = config | (1 << 4); +    } else { +        throw uhd::runtime_error("[ad9361_device_t] Can not read both chains synchronously"); +    } + +    if(direction == RX) +    { +        base = 0xF0; +    } else { +        base = 0x60; +    } + +    _io_iface->poke8(base+5,config); + +    std::vector<boost::int16_t> taps; +    boost::uint8_t lower_val; +    boost::uint8_t higher_val; +    boost::uint16_t coeff; +    for(size_t i = 0;i < num_taps;i++) +    { +        _io_iface->poke8(base,0x00+i); +        lower_val = _io_iface->peek8(base+3); +        higher_val = _io_iface->peek8(base+4); +        coeff = ((higher_val << 8) | lower_val); +        taps.push_back(boost::int16_t(coeff)); +    } + +    config = (config & (~(1 << 1))); //disable filter clock +    _io_iface->poke8(base+5,config); +    return taps; +} + +/* + * Returns either RX TIA LPF or TX Secondary LPF + * depending on the direction. + * See UG570 for details on used scaling factors. */ +filter_info_base::sptr ad9361_device_t::_get_filter_lp_tia_sec(direction_t direction) +{ +    double cutoff = 0; + +    if(direction == RX) +    { +       cutoff = 2.5 * _rx_tia_lp_bw; +    } else { +       cutoff = 5 * _tx_sec_lp_bw; +    } + +    filter_info_base::sptr lp(new analog_filter_lp(filter_info_base::ANALOG_LOW_PASS, false, 0, "single-pole", cutoff, 20)); +    return  lp; +} + +/* + * Returns RX/TX BB LPF. + * See UG570 for details on used scaling factors. */ +filter_info_base::sptr ad9361_device_t::_get_filter_lp_bb(direction_t direction) +{ +    double cutoff = 0; +    if(direction == RX) +    { +        cutoff = 1.4 * _rx_bb_lp_bw; +    } else { +        cutoff = 1.6 * _tx_bb_lp_bw; +    } + +    filter_info_base::sptr bb_lp(new analog_filter_lp(filter_info_base::ANALOG_LOW_PASS, false, 1, "third-order Butterworth", cutoff, 60)); +    return  bb_lp; +} + +/* + * For RX direction the DEC3 is returned. + * For TX direction the INT3 is returned. */ +filter_info_base::sptr ad9361_device_t::_get_filter_dec_int_3(direction_t direction) +{ +    boost::uint8_t enable = 0; +    double rate = _adcclock_freq; +    double full_scale; +    size_t dec = 0; +    size_t interpol = 0; +    filter_info_base::filter_type type = filter_info_base::DIGITAL_I16; +    std::string name; +    boost::int16_t taps_array_rx[] = {55, 83, 0, -393, -580, 0, 1914, 4041, 5120, 4041, 1914, 0, -580, -393, 0, 83, 55}; +    boost::int16_t taps_array_tx[] = {36, -19, 0, -156, -12, 0, 479, 233, 0, -1215, -993, 0, 3569, 6277, 8192, 6277, 3569, 0, -993, -1215, 0, 223, 479, 0, -12, -156, 0, -19, 36}; +    std::vector<boost::int16_t> taps; + +    filter_info_base::sptr ret; + +    if(direction == RX) +    { +        full_scale = 16384; +        dec = 3; +        interpol = 1; + +        enable = _io_iface->peek8(0x003); +        enable = ((enable >> 4) & 0x03); +        taps.assign(taps_array_rx, taps_array_rx + sizeof(taps_array_rx) / sizeof(boost::int16_t) ); + +    } else { +        full_scale = 8192; +        dec = 1; +        interpol = 3; + +        boost::uint8_t use_dac_clk_div = _io_iface->peek8(0x00A); +        use_dac_clk_div = ((use_dac_clk_div >> 3) & 0x01); +        if(use_dac_clk_div == 1) +        { +            rate = rate / 2; +        } + +        enable = _io_iface->peek8(0x002); +        enable = ((enable >> 4) & 0x03); +        if(enable == 2) //0 => int. by 1, 1 => int. by 2 (HB3), 2 => int. by 3 +        { +            rate /= 3; +        } + +        taps.assign(taps_array_tx, taps_array_tx + sizeof(taps_array_tx) / sizeof(boost::int16_t) ); +    } + +    ret = filter_info_base::sptr(new digital_filter_base<boost::int16_t>(type, (enable != 2) ? true : false, 2, rate, interpol, dec, full_scale, taps.size(), taps)); +    return  ret; +} + +filter_info_base::sptr ad9361_device_t::_get_filter_hb_3(direction_t direction) +{ +    boost::uint8_t enable = 0; +    double rate = _adcclock_freq; +    double full_scale = 0; +    size_t dec = 1; +    size_t interpol = 1; +    filter_info_base::filter_type type = filter_info_base::DIGITAL_I16; +    boost::int16_t taps_array_rx[] = {1, 4, 6, 4, 1}; +    boost::int16_t taps_array_tx[] = {1, 2, 1}; +    std::vector<boost::int16_t> taps; + +    if(direction == RX) +    { +        full_scale = 16; +        dec = 2; + +        enable = _io_iface->peek8(0x003); +        enable = ((enable >> 4) & 0x03); +        taps.assign(taps_array_rx, taps_array_rx + sizeof(taps_array_rx) / sizeof(boost::int16_t) ); +    } else { +        full_scale = 2; +        interpol = 2; + +        boost::uint8_t use_dac_clk_div = _io_iface->peek8(0x00A); +        use_dac_clk_div = ((use_dac_clk_div >> 3) & 0x01); +        if(use_dac_clk_div == 1) +        { +            rate = rate / 2; +        } + +        enable = _io_iface->peek8(0x002); +        enable = ((enable >> 4) & 0x03); +        if(enable == 1) +        { +            rate /= 2; +        } +        taps.assign(taps_array_tx, taps_array_tx + sizeof(taps_array_tx) / sizeof(boost::int16_t) ); +    } + +    filter_info_base::sptr hb = filter_info_base::sptr(new digital_filter_base<boost::int16_t>(type, (enable != 1) ? true : false, 2, rate, interpol, dec, full_scale, taps.size(), taps)); +    return  hb; +} + +filter_info_base::sptr ad9361_device_t::_get_filter_hb_2(direction_t direction) +{ +    boost::uint8_t enable = 0; +    double rate = _adcclock_freq; +    double full_scale = 0; +    size_t dec = 1; +    size_t interpol = 1; +    filter_info_base::filter_type type = filter_info_base::DIGITAL_I16; +    boost::int16_t taps_array[] = {-9, 0, 73, 128, 73, 0, -9}; +    std::vector<boost::int16_t> taps(taps_array, taps_array + sizeof(taps_array) / sizeof(boost::int16_t) ); + +    digital_filter_base<boost::int16_t>::sptr hb_3 = boost::dynamic_pointer_cast<digital_filter_base<boost::int16_t> >(_get_filter_hb_3(direction)); +    digital_filter_base<boost::int16_t>::sptr dec_int_3 = boost::dynamic_pointer_cast<digital_filter_base<boost::int16_t> >(_get_filter_dec_int_3(direction)); + +    if(direction == RX) +    { +        full_scale = 256; +        dec = 2; +        enable = _io_iface->peek8(0x003); +    } else { +        full_scale = 128; +        interpol = 2; +        enable = _io_iface->peek8(0x002); +    } + +    enable = ((enable >> 3) & 0x01); + +    if(!(hb_3->is_bypassed())) +    { +        if(direction == RX) +        { +            rate = hb_3->get_output_rate(); +        }else if (direction == TX) { +            rate = hb_3->get_input_rate(); +            if(enable) +            { +                rate /= 2; +            } +        } +    } else { //else dec3/int3 or none of them is used. +        if(direction == RX) +        { +            rate = dec_int_3->get_output_rate(); +        }else if (direction == TX) { +            rate = dec_int_3->get_input_rate(); +            if(enable) +            { +                rate /= 2; +            } +        } +    } + +    filter_info_base::sptr hb(new digital_filter_base<boost::int16_t>(type, (enable == 0) ? true : false, 3, rate, interpol, dec, full_scale, taps.size(), taps)); +    return  hb; +} + +filter_info_base::sptr ad9361_device_t::_get_filter_hb_1(direction_t direction) +{ +    boost::uint8_t enable = 0; +    double rate = 0; +    double full_scale = 0; +    size_t dec = 1; +    size_t interpol = 1; +    filter_info_base::filter_type type = filter_info_base::DIGITAL_I16; + +    std::vector<boost::int16_t> taps; +    boost::int16_t taps_rx_array[] = {-8, 0, 42, 0, -147, 0, 619, 1013, 619, 0, -147, 0, 42, 0, -8}; +    boost::int16_t taps_tx_array[] = {-53, 0, 313, 0, -1155, 0, 4989, 8192, 4989, 0, -1155, 0, 313, 0, -53}; + +    digital_filter_base<boost::int16_t>::sptr hb_2 = boost::dynamic_pointer_cast<digital_filter_base<boost::int16_t> >(_get_filter_hb_2(direction)); + +    if(direction == RX) +    { +        full_scale = 2048; +        dec = 2; +        enable = _io_iface->peek8(0x003); +        enable = ((enable >> 2) & 0x01); +        rate = hb_2->get_output_rate(); +        taps.assign(taps_rx_array, taps_rx_array + sizeof(taps_rx_array) / sizeof(boost::int16_t) ); +    } else if (direction == TX) { +        full_scale = 8192; +        interpol = 2; +        enable = _io_iface->peek8(0x002); +        enable = ((enable >> 2) & 0x01); +        rate = hb_2->get_input_rate(); +        if(enable) +        { +            rate /= 2; +        } +        taps.assign(taps_tx_array, taps_tx_array + sizeof(taps_tx_array) / sizeof(boost::int16_t) ); +    } + +    filter_info_base::sptr hb(new digital_filter_base<boost::int16_t>(type, (enable == 0) ? true : false, 4, rate, interpol, dec, full_scale, taps.size(), taps)); +    return  hb; +} + +filter_info_base::sptr ad9361_device_t::_get_filter_fir(direction_t direction, chain_t chain) +{ +    double rate = 0; +    size_t dec = 1; +    size_t interpol = 1; +    size_t max_num_taps = 128; +    boost::uint8_t enable = 1; + +    digital_filter_base<boost::int16_t>::sptr hb_1 = boost::dynamic_pointer_cast<digital_filter_base<boost::int16_t> >(_get_filter_hb_1(direction)); + +    if(direction == RX) +    { +        dec = _get_fir_dec_int(direction); +        if(dec == 0) +        { +            enable = 0; +            dec = 1; +        } +        interpol = 1; +        rate = hb_1->get_output_rate(); +    }else if (direction == TX) { +        interpol = _get_fir_dec_int(direction); +        if(interpol == 0) +        { +            enable = 0; +            interpol = 1; +        } +        dec = 1; +        rate = hb_1->get_input_rate(); +        if(enable) +        { +            rate /= interpol; +        } +    } +    max_num_taps = _get_num_fir_taps(direction); + +    filter_info_base::sptr fir(new digital_filter_fir<boost::int16_t>(filter_info_base::DIGITAL_FIR_I16, (enable == 0) ? true : false, 5, rate, interpol, dec, 32767, max_num_taps, _get_fir_taps(direction, chain))); + +    return fir; +} + +void ad9361_device_t::_set_filter_fir(direction_t direction, chain_t channel, filter_info_base::sptr filter) +{ +    digital_filter_fir<boost::int16_t>::sptr fir = boost::dynamic_pointer_cast<digital_filter_fir<boost::int16_t> >(filter); +    //only write taps. Ignore everything else for now +    _set_fir_taps(direction, channel, fir->get_taps()); +} + +/* + * If BW of one of the analog filters gets overwritten manually, + * _tx_analog_bw and _rx_analog_bw are not valid any more! + * For useful data in those variables set_bw_filter method should be used + */ +void ad9361_device_t::_set_filter_lp_bb(direction_t direction, filter_info_base::sptr filter) +{ +    analog_filter_lp::sptr lpf = boost::dynamic_pointer_cast<analog_filter_lp>(filter); +    double bw = lpf->get_cutoff(); +    if(direction == RX) +    { +        //remember: this function takes rf bw as its input and calibrated to 1.4 x the given value +        _rx_bb_lp_bw = _calibrate_baseband_rx_analog_filter(2 * bw / 1.4); //returns bb bw + +    } else { +        //remember: this function takes rf bw as its input and calibrates to 1.6 x the given value +        _tx_bb_lp_bw = _calibrate_baseband_tx_analog_filter(2 * bw / 1.6); +    } +} + +void ad9361_device_t::_set_filter_lp_tia_sec(direction_t direction, filter_info_base::sptr filter) +{ +    analog_filter_lp::sptr lpf = boost::dynamic_pointer_cast<analog_filter_lp>(filter); +    double bw = lpf->get_cutoff(); +    if(direction == RX) +    { +        //remember: this function takes rf bw as its input and calibrated to 2.5 x the given value +        _rx_tia_lp_bw = _calibrate_rx_TIAs(2 * bw / 2.5); //returns bb bw + +    } else { +        //remember: this function takes rf bw as its input and calibrates to 5 x the given value +        _tx_sec_lp_bw = _calibrate_secondary_tx_filter(2 * bw / 5); +    } +} +  }} diff --git a/host/lib/usrp/common/ad9361_driver/ad9361_device.h b/host/lib/usrp/common/ad9361_driver/ad9361_device.h index 7c53ff0c4..a242f35e9 100644 --- a/host/lib/usrp/common/ad9361_driver/ad9361_device.h +++ b/host/lib/usrp/common/ad9361_driver/ad9361_device.h @@ -8,6 +8,14 @@  #include <ad9361_client.h>  #include <boost/noncopyable.hpp>  #include <boost/thread/recursive_mutex.hpp> +#include <uhd/types/filters.hpp> +#include <uhd/types/sensors.hpp> +#include <complex> +#include <vector> +#include <map> +#include "boost/assign.hpp" +#include "boost/bind.hpp" +#include "boost/function.hpp"  namespace uhd { namespace usrp { @@ -15,11 +23,34 @@ class ad9361_device_t : public boost::noncopyable  {  public:      enum direction_t { RX, TX }; -    enum chain_t { CHAIN_1, CHAIN_2 };      enum gain_mode_t {GAIN_MODE_MANUAL, GAIN_MODE_SLOW_AGC, GAIN_MODE_FAST_AGC}; +    enum chain_t { CHAIN_1, CHAIN_2, CHAIN_BOTH };      ad9361_device_t(ad9361_params::sptr client, ad9361_io::sptr io_iface) : -        _client_params(client), _io_iface(io_iface) {} +        _client_params(client), _io_iface(io_iface) { + +        _rx_filters = boost::assign::map_list_of("LPF_TIA", filter_query_helper(boost::bind(&ad9361_device_t::_get_filter_lp_tia_sec, this, _1), +                                                    boost::bind(&ad9361_device_t::_set_filter_lp_tia_sec, this, _1, _3))) +                                            ("LPF_BB", filter_query_helper(boost::bind(&ad9361_device_t::_get_filter_lp_bb, this, _1), +                                                    boost::bind(&ad9361_device_t::_set_filter_lp_bb, this, _1, _3))) +                                            ("HB_3", filter_query_helper(boost::bind(&ad9361_device_t::_get_filter_hb_3, this, _1), 0)) +                                            ("DEC_3", filter_query_helper(boost::bind(&ad9361_device_t::_get_filter_dec_int_3, this, _1), 0)) +                                            ("HB_2", filter_query_helper(boost::bind(&ad9361_device_t::_get_filter_hb_2, this, _1), 0)) +                                            ("HB_1", filter_query_helper(boost::bind(&ad9361_device_t::_get_filter_hb_1, this, _1), 0)) +                                            ("FIR_1", filter_query_helper(boost::bind(&ad9361_device_t::_get_filter_fir, this, _1, _2), +                                                    boost::bind(&ad9361_device_t::_set_filter_fir, this, _1, _2, _3))); + +        _tx_filters = boost::assign::map_list_of("LPF_SECONDARY", filter_query_helper(boost::bind(&ad9361_device_t::_get_filter_lp_tia_sec, this, _1), +                                                    boost::bind(&ad9361_device_t::_set_filter_lp_tia_sec, this, _1, _3))) +                                            ("LPF_BB", filter_query_helper(boost::bind(&ad9361_device_t::_get_filter_lp_bb, this, _1), +                                                    boost::bind(&ad9361_device_t::_set_filter_lp_bb, this, _1, _3))) +                                            ("HB_3", filter_query_helper(boost::bind(&ad9361_device_t::_get_filter_hb_3, this, _1), 0)) +                                            ("INT_3", filter_query_helper(boost::bind(&ad9361_device_t::_get_filter_dec_int_3, this, _1), 0)) +                                            ("HB_2", filter_query_helper(boost::bind(&ad9361_device_t::_get_filter_hb_2, this, _1), 0)) +                                            ("HB_1", filter_query_helper(boost::bind(&ad9361_device_t::_get_filter_hb_1, this, _1), 0)) +                                            ("FIR_1", filter_query_helper(boost::bind(&ad9361_device_t::_get_filter_fir, this, _1, _2), +                                                    boost::bind(&ad9361_device_t::_set_filter_fir, this, _1, _2, _3))); +    }      /* Initialize the AD9361 codec. */      void initialize(); @@ -85,6 +116,19 @@ public:      /* Enable AD9361's AGC gain mode. */      void set_agc(chain_t chain, bool enable); +    /* Set bandwidth of AD9361's analog LP filters. +     * Bandwidth should be RF bandwidth */ +    double set_bw_filter(direction_t direction, const double rf_bw); + +    /* +     * Filter API implementation +     * */ +    filter_info_base::sptr get_filter(direction_t direction, chain_t chain, const std::string &name); + +    void set_filter(direction_t direction, chain_t chain, const std::string &name, filter_info_base::sptr filter); + +    std::vector<std::string> get_filter_names(direction_t direction); +      //Constants      static const double AD9361_MAX_GAIN;      static const double AD9361_MAX_CLOCK_RATE; @@ -95,12 +139,15 @@ private:    //Methods      void _program_fir_filter(direction_t direction, int num_taps, boost::uint16_t *coeffs);      void _setup_tx_fir(size_t num_taps, boost::int32_t interpolation);      void _setup_rx_fir(size_t num_taps, boost::int32_t decimation); +    void _program_fir_filter(direction_t direction, chain_t chain, int num_taps, boost::uint16_t *coeffs); +    void _setup_tx_fir(size_t num_taps); +    void _setup_rx_fir(size_t num_taps);      void _calibrate_lock_bbpll();      void _calibrate_synth_charge_pumps(); -    double _calibrate_baseband_rx_analog_filter(); -    double _calibrate_baseband_tx_analog_filter(); -    void _calibrate_secondary_tx_filter(); -    void _calibrate_rx_TIAs(); +    double _calibrate_baseband_rx_analog_filter(double rfbw); +    double _calibrate_baseband_tx_analog_filter(double rfbw); +    double _calibrate_secondary_tx_filter(double rfbw); +    double _calibrate_rx_TIAs(double rfbw);      void _setup_adc();      void _calibrate_baseband_dc_offset();      void _calibrate_rf_dc_offset(); @@ -118,6 +165,20 @@ private:    //Methods      double _get_temperature(const double cal_offset, const double timeout = 0.1);      void _configure_bb_rf_dc_tracking(const bool on);      void _setup_agc(chain_t chain, gain_mode_t gain_mode); +    void _set_fir_taps(direction_t direction, chain_t chain, const std::vector<boost::int16_t>& taps); +    std::vector<boost::int16_t> _get_fir_taps(direction_t direction, chain_t chain); +    size_t _get_num_fir_taps(direction_t direction); +    size_t _get_fir_dec_int(direction_t direction); +    filter_info_base::sptr _get_filter_lp_tia_sec(direction_t direction); +    filter_info_base::sptr _get_filter_lp_bb(direction_t direction); +    filter_info_base::sptr _get_filter_dec_int_3(direction_t direction); +    filter_info_base::sptr _get_filter_hb_3(direction_t direction); +    filter_info_base::sptr _get_filter_hb_2(direction_t direction); +    filter_info_base::sptr _get_filter_hb_1(direction_t direction); +    filter_info_base::sptr _get_filter_fir(direction_t direction, chain_t chain); +    void _set_filter_fir(direction_t direction, chain_t channel, filter_info_base::sptr filter); +    void _set_filter_lp_bb(direction_t direction, filter_info_base::sptr filter); +    void _set_filter_lp_tia_sec(direction_t direction, filter_info_base::sptr filter);  private:    //Members      typedef struct { @@ -130,6 +191,22 @@ private:    //Members          boost::uint8_t bbftune_mode;      } chip_regs_t; +    struct filter_query_helper +    { +        filter_query_helper( +                boost::function<filter_info_base::sptr (direction_t, chain_t)> p_get, +                boost::function<void (direction_t, chain_t, filter_info_base::sptr)> p_set +                ) : get(p_get), set(p_set) {  } + +        filter_query_helper(){ } + +        boost::function<filter_info_base::sptr (direction_t, chain_t)> get; +        boost::function<void (direction_t, chain_t, filter_info_base::sptr)> set; +    }; + +    std::map<std::string, filter_query_helper> _rx_filters; +    std::map<std::string, filter_query_helper> _tx_filters; +      //Interfaces      ad9361_params::sptr _client_params;      ad9361_io::sptr     _io_iface; @@ -137,6 +214,8 @@ private:    //Members      double              _rx_freq, _tx_freq, _req_rx_freq, _req_tx_freq;      double              _last_calibration_freq;      double              _baseband_bw, _bbpll_freq, _adcclock_freq; +    double              _rx_analog_bw, _tx_analog_bw, _rx_bb_lp_bw, _tx_bb_lp_bw; +    double              _rx_tia_lp_bw, _tx_sec_lp_bw;      double              _req_clock_rate, _req_coreclk;      boost::uint16_t     _rx_bbf_tunediv;      boost::uint8_t      _curr_gain_table; | 
