#include "WireCellSigProc/SimpleChannelNoiseDB.h"
#include "WireCellAux/DftTools.h"
#include "WireCellUtil/Response.h"
#include "WireCellUtil/Binning.h"

#include "WireCellUtil/NamedFactory.h"

WIRECELL_FACTORY(testChannelNoiseDB, WireCell::SigProc::SimpleChannelNoiseDB, WireCell::IChannelNoiseDatabase)

using namespace WireCell;
using namespace WireCell::SigProc;
using WireCell::Aux::DftTools::fwd_r2c;


SimpleChannelNoiseDB::SimpleChannelNoiseDB(double tick, int nsamples)
  : m_tick(-1)
  , m_nsamples(-1)
  , m_default_baseline(0.0)
  , m_default_gain(1.0)
  , m_default_offset(0.0)
  , m_default_min_rms(0.5)
  , m_default_max_rms(10)
  , m_default_pad_f(0)
  , m_default_pad_b(0)
  , m_default_decon_limit(0.02)
  , m_default_decon_lf_cutoff(0.08)
  , m_default_adc_limit(15.0)
  , m_default_decon_limit1(0.08)
  , m_default_protection_factor(5.0)
  , m_default_min_adc_limit(50)
  , m_default_roi_min_max_ratio(0.8)
{
    set_sampling(tick, nsamples);
}
SimpleChannelNoiseDB::~SimpleChannelNoiseDB() {}

void SimpleChannelNoiseDB::configure(const WireCell::Configuration& cfg)
{
    std::string dft_tn = get<std::string>(cfg, "dft", "FftwDFT");
    m_dft = Factory::find_tn<IDFT>(dft_tn);
}

WireCell::Configuration SimpleChannelNoiseDB::default_configuration() const
{
    Configuration cfg;
    cfg["dft"] = "FftwDFT";     // type-name for the DFT to use
    return cfg;
}


double SimpleChannelNoiseDB::nominal_baseline(int channel) const
{
    const int ind = chind(channel);
    if (0 <= ind && ind < (int) m_baseline.size()) {
        return m_baseline[ind];
    }
    return m_default_baseline;
}

double SimpleChannelNoiseDB::gain_correction(int channel) const
{
    const int ind = chind(channel);
    if (0 <= ind && ind < (int) m_gain.size()) {
        return m_gain[ind];
    }
    return m_default_gain;
}

double SimpleChannelNoiseDB::response_offset(int channel) const
{
    const int ind = chind(channel);
    if (0 <= ind && ind < (int) m_offset.size()) {
        return m_offset[ind];
    }
    return m_default_offset;
}

double SimpleChannelNoiseDB::min_rms_cut(int channel) const
{
    const int ind = chind(channel);
    if (0 <= ind && ind < (int) m_min_rms.size()) {
        return m_min_rms[ind];
    }
    return m_default_min_rms;
}

double SimpleChannelNoiseDB::max_rms_cut(int channel) const
{
    const int ind = chind(channel);
    if (0 <= ind && ind < (int) m_max_rms.size()) {
        return m_max_rms[ind];
    }
    return m_default_max_rms;
}

int SimpleChannelNoiseDB::pad_window_front(int channel) const
{
    const int ind = chind(channel);
    if (0 <= ind && ind < (int) m_pad_f.size()) {
        return m_pad_f[ind];
    }
    return m_default_pad_f;
}

int SimpleChannelNoiseDB::pad_window_back(int channel) const
{
    const int ind = chind(channel);
    if (0 <= ind && ind < (int) m_pad_b.size()) {
        return m_pad_b[ind];
    }
    return m_default_pad_b;
}

float SimpleChannelNoiseDB::coherent_nf_decon_limit(int channel) const
{
    const int ind = chind(channel);
    if (0 <= ind && ind < (int) m_decon_limit.size()) {
        return m_decon_limit[ind];
    }
    return m_default_decon_limit;
}

float SimpleChannelNoiseDB::coherent_nf_decon_lf_cutoff(int channel) const
{
    const int ind = chind(channel);
    if (0 <= ind && ind < (int) m_decon_lf_cutoff.size()) {
        return m_decon_lf_cutoff[ind];
    }
    return m_default_decon_lf_cutoff;
}

float SimpleChannelNoiseDB::coherent_nf_decon_limit1(int channel) const
{
    const int ind = chind(channel);
    if (0 <= ind && ind < (int) m_decon_limit1.size()) {
        return m_decon_limit1[ind];
    }
    return m_default_decon_limit1;
}

float SimpleChannelNoiseDB::coherent_nf_adc_limit(int channel) const
{
    const int ind = chind(channel);
    if (0 <= ind && ind < (int) m_adc_limit.size()) {
        return m_adc_limit[ind];
    }
    return m_default_adc_limit;
}

float SimpleChannelNoiseDB::coherent_nf_protection_factor(int channel) const
{
    const int ind = chind(channel);
    if (0 <= ind && ind < (int) m_protection_factor.size()) {
        return m_protection_factor[ind];
    }
    return m_default_protection_factor;
}

float SimpleChannelNoiseDB::coherent_nf_min_adc_limit(int channel) const
{
    const int ind = chind(channel);
    if (0 <= ind && ind < (int) m_min_adc_limit.size()) {
        return m_min_adc_limit[ind];
    }
    return m_default_min_adc_limit;
}

float SimpleChannelNoiseDB::coherent_nf_roi_min_max_ratio(int channel) const
{
    const int ind = chind(channel);
    if (0 <= ind && ind < (int) m_roi_min_max_ratio.size()) {
        return m_roi_min_max_ratio[ind];
    }
    return m_default_roi_min_max_ratio;
}

const IChannelNoiseDatabase::filter_t& SimpleChannelNoiseDB::get_filter(int channel, const filter_vector_t& fv) const
{
    const int ind = chind(channel);
    // std::cerr << "ch=" << channel << " ind=" << ind << " " << fv.size() << std::endl;
    if (0 <= ind && ind < (int) fv.size()) {
        const shared_filter_t sf = fv[ind];
        if (sf == nullptr) {
            return *(m_default_filter.get());
        }

        const filter_t* filtp = sf.get();
        return *filtp;
    }
    const filter_t* filtp = m_default_filter.get();
    // std::cerr << "Filter: "<< (void*)filtp << std::endl;
    return *filtp;
}

const IChannelNoiseDatabase::filter_t& SimpleChannelNoiseDB::rcrc(int channel) const
{
    return get_filter(channel, m_rcrc);
}

const IChannelNoiseDatabase::filter_t& SimpleChannelNoiseDB::config(int channel) const
{
    return get_filter(channel, m_config);
}

const IChannelNoiseDatabase::filter_t& SimpleChannelNoiseDB::noise(int channel) const
{
    return get_filter(channel, m_masks);
}

const IChannelNoiseDatabase::filter_t& SimpleChannelNoiseDB::response(int channel) const
{
    return get_filter(channel, m_response);
}

void SimpleChannelNoiseDB::set_sampling(double tick, int nsamples)
{
    if (m_nsamples == nsamples && tick == m_tick) {
        // std::cerr << "Sampling unchanged: " << nsamples << " @ " << m_tick/units::ms << " ms" << std::endl;
        return;
    }
    m_nsamples = nsamples;
    m_tick = tick;

    m_rcrc.clear();
    m_config.clear();
    m_response.clear();

    Waveform::compseq_t spectrum;
    spectrum.resize(nsamples, std::complex<float>(1, 0));
    m_default_filter = std::make_shared<filter_t>(spectrum);
    Waveform::compseq_t empty;
    m_default_response = std::make_shared<filter_t>(empty);
}

// set one thing in a vector at the index, resizing if needed, use def
// to back fill in case of resizing
template <typename T>
void set_one(int ind, T val, std::vector<T>& vec, T def)
{
    if (ind >= (int) vec.size()) {
        vec.resize(ind + 1, def);
    }
    vec[ind] = val;
}

void SimpleChannelNoiseDB::set_nominal_baseline(const std::vector<int>& channels, double baseline)
{
    // std::cerr << "SimpleChannelNoiseDB: set baseline to " << channels.size() << " chans: " << baseline << std::endl;
    for (auto ch : channels) {
        set_one(chind(ch), baseline, m_baseline, m_default_baseline);
    }
}
void SimpleChannelNoiseDB::set_rcrc_constant(const std::vector<int>& channels, double rcrc)
{
    Response::SimpleRC rcres(rcrc, m_tick);
    // auto signal = rcres.generate(WireCell::Waveform::Domain(0, m_nsamples*m_tick), m_nsamples);
    //    auto signal = rcres.generate(WireCell::Binning(m_nsamples, 0, m_nsamples*m_tick));
    auto signal = rcres.generate(WireCell::Waveform::Domain(0, m_nsamples * m_tick), m_nsamples);

    Waveform::compseq_t spectrum = fwd_r2c(m_dft, signal);

    // std::cout << rcrc << " " << m_tick << " " << m_nsamples << " " << signal.front() << " " << signal.at(1) << " " <<
    // signal.at(2) << std::endl;

    // get the square of it because there are two RC filters
    Waveform::compseq_t spectrum2 = spectrum;
    Waveform::scale(spectrum2, spectrum);
    // for (auto it : spectrum){
    //   float real_part = it.real();
    //   float imag_part = it.imag();
    //   std::complex<float> temp(real_part*real_part-imag_part*imag_part,2*real_part*imag_part);
    //   spectrum2.push_back(temp);
    // }

    // std::cerr << "SimpleChannelNoiseDB:: get rcrc as: " << rcrc
    //           << " sum=" << Waveform::sum(spectrum2)
    //           << std::endl;

    auto filt = std::make_shared<filter_t>(spectrum2);

    for (auto ch : channels) {
        set_one(chind(ch), filt, m_rcrc, m_default_filter);
    }
}

void SimpleChannelNoiseDB::set_response(const std::vector<int>& channels, const filter_t& spectrum)
{
    // std::cerr << "SimpleChannelNoiseDB: set respnose on " << channels.size() << " chans with: " << spectrum.size() <<
    // " samples\n";

    auto filt = std::make_shared<filter_t>(spectrum);
    for (auto ch : channels) {
        set_one(chind(ch), filt, m_response, m_default_response);
    }
}

void SimpleChannelNoiseDB::set_gains_shapings(const std::vector<int>& channels, double from_gain, double to_gain,
                                              double from_shaping, double to_shaping)
{
    const double gain_ratio = to_gain / from_gain;
    // std::cerr << "SimpleChannelNoiseDB: set gain/shaping on " << channels.size() << " chans to: "
    //           << "g=" << from_gain << "->" << to_gain << ", "
    //           << "s=" << from_shaping << "->" << to_shaping << ", "
    //           << "rat=" << gain_ratio
    //           << "m_tick=" << m_tick/units::us << " us"
    //           << "\n";

    Response::ColdElec from_ce(from_gain, from_shaping);
    Response::ColdElec to_ce(to_gain, to_shaping);
    // auto to_sig   =   to_ce.generate(WireCell::Binning(m_nsamples, 0, m_nsamples*m_tick));
    // auto from_sig = from_ce.generate(WireCell::Binning(m_nsamples, 0, m_nsamples*m_tick));
    auto to_sig = to_ce.generate(WireCell::Waveform::Domain(0, m_nsamples * m_tick), m_nsamples);
    auto from_sig = from_ce.generate(WireCell::Waveform::Domain(0, m_nsamples * m_tick), m_nsamples);

    auto to_filt = fwd_r2c(m_dft, to_sig);

    auto from_filt = fwd_r2c(m_dft, from_sig);

    // auto from_filt_sum = Waveform::sum(from_filt);
    // auto to_filt_sum   = Waveform::sum(to_filt);

    Waveform::shrink(to_filt, from_filt);  // divide
    auto filt = std::make_shared<filter_t>(to_filt);

    // std::cout << filt->at(0) << " " << filt->at(1) << std::endl;
    // std::cerr << "SimpleChannelNoiseDB: "
    //           << " from_sig sum=" << Waveform::sum(from_sig)
    //           << " to_sig sum=" << Waveform::sum(to_sig)
    //           << " from_filt sum=" << from_filt_sum
    //           << " to_filt sum=" << to_filt_sum
    //           << " rat_filt sum=" << Waveform::sum(to_filt)
    //           << std::endl;

    for (auto ch : channels) {
        int ind = chind(ch);
        set_one(ind, filt, m_config, m_default_filter);
        set_one(ind, gain_ratio, m_gain, m_default_gain);
    }
}

void SimpleChannelNoiseDB::set_response_offset(const std::vector<int>& channels, double offset)
{
    // std::cerr << "SimpleChannelNoiseDB: set response offset " << channels.size() << " chans to: " << offset <<
    // std::endl;
    for (auto ch : channels) {
        int ind = chind(ch);
        set_one(ind, offset, m_offset, m_default_offset);
    }
}

void SimpleChannelNoiseDB::set_min_rms_cut(const std::vector<int>& channels, double min_rms)
{
    // std::cerr << "SimpleChannelNoiseDB: set min rms cut on "<<channels.size()<<":[" << channels.front() << "," <<
    // channels.back() << "] to: " << min_rms << std::endl;
    for (auto ch : channels) {
        int ind = chind(ch);
        set_one(ind, min_rms, m_min_rms, m_default_min_rms);
    }
}

void SimpleChannelNoiseDB::set_min_rms_cut_one(int ch, double min_rms)
{
    // std::cerr << "SimpleChannelNoiseDB: set min rms cut on " << ch << " to: " << min_rms << std::endl;
    int ind = chind(ch);
    set_one(ind, min_rms, m_min_rms, m_default_min_rms);
}

void SimpleChannelNoiseDB::set_max_rms_cut(const std::vector<int>& channels, double max_rms)
{
    // std::cerr << "SimpleChannelNoiseDB: set max rms cut on "<<channels.size()<<":[" << channels.front() << "," <<
    // channels.back() << "] to: " << max_rms << std::endl;
    for (auto ch : channels) {
        int ind = chind(ch);
        set_one(ind, max_rms, m_max_rms, m_default_max_rms);
    }
}

void SimpleChannelNoiseDB::set_max_rms_cut_one(int ch, double max_rms)
{
    // std::cerr << "SimpleChannelNoiseDB: set max rms cut on " << ch << " to: " << max_rms << std::endl;
    int ind = chind(ch);
    set_one(ind, max_rms, m_max_rms, m_default_max_rms);
}

void SimpleChannelNoiseDB::set_pad_window_front(const std::vector<int>& channels, int pad_f)
{
    // std::cerr << "SimpleChannelNoiseDB: set pad window front on " << channels.size() << " channels: " << pad_f <<
    // std::endl;
    for (auto ch : channels) {
        int ind = chind(ch);
        set_one(ind, pad_f, m_pad_f, m_default_pad_f);
    }
}

void SimpleChannelNoiseDB::set_pad_window_back(const std::vector<int>& channels, int pad_b)
{
    // std::cerr << "SimpleChannelNoiseDB: set pad window back on " << channels.size() << " channels: " << pad_b <<
    // std::endl;
    for (auto ch : channels) {
        int ind = chind(ch);
        set_one(ind, pad_b, m_pad_b, m_default_pad_b);
    }
}

void SimpleChannelNoiseDB::set_coherent_nf_decon_limit(const std::vector<int>& channels, float decon_limit)
{
    // std::cerr << "SimpleChannelNoiseDB: set pad window back on " << channels.size() << " channels: " << pad_b <<
    // std::endl;
    for (auto ch : channels) {
        int ind = chind(ch);
        set_one(ind, decon_limit, m_decon_limit, m_default_decon_limit);
    }
}

void SimpleChannelNoiseDB::set_coherent_nf_decon_lf_cutoff(const std::vector<int>& channels, float decon_lf_cutoff)
{
    // std::cerr << "SimpleChannelNoiseDB: set pad window back on " << channels.size() << " channels: " << pad_b <<
    // std::endl;
    for (auto ch : channels) {
        int ind = chind(ch);
        set_one(ind, decon_lf_cutoff, m_decon_lf_cutoff, m_default_decon_lf_cutoff);
    }
}

void SimpleChannelNoiseDB::set_coherent_nf_decon_limit1(const std::vector<int>& channels, float decon_limit1)
{
    // std::cerr << "SimpleChannelNoiseDB: set pad window back on " << channels.size() << " channels: " << pad_b <<
    // std::endl;
    for (auto ch : channels) {
        int ind = chind(ch);
        set_one(ind, decon_limit1, m_decon_limit1, m_default_decon_limit1);
    }
}

void SimpleChannelNoiseDB::set_coherent_nf_adc_limit(const std::vector<int>& channels, float adc_limit)
{
    // std::cerr << "SimpleChannelNoiseDB: set pad window back on " << channels.size() << " channels: " << pad_b <<
    // std::endl;
    for (auto ch : channels) {
        int ind = chind(ch);
        set_one(ind, adc_limit, m_adc_limit, m_default_adc_limit);
    }
}

void SimpleChannelNoiseDB::set_coherent_nf_protection_factor(const std::vector<int>& channels, float protection_factor)
{
    // std::cerr << "SimpleChannelNoiseDB: set pad window back on " << channels.size() << " channels: " << pad_b <<
    // std::endl;
    for (auto ch : channels) {
        int ind = chind(ch);
        set_one(ind, protection_factor, m_protection_factor, m_default_protection_factor);
    }
}

void SimpleChannelNoiseDB::set_coherent_nf_min_adc_limit(const std::vector<int>& channels, float min_adc_limit)
{
    // std::cerr << "SimpleChannelNoiseDB: set pad window back on " << channels.size() << " channels: " << pad_b <<
    // std::endl;
    for (auto ch : channels) {
        int ind = chind(ch);
        set_one(ind, min_adc_limit, m_min_adc_limit, m_default_min_adc_limit);
    }
}

void SimpleChannelNoiseDB::set_coherent_nf_roi_min_max_ratio(const std::vector<int>& channels, float roi_min_max_ratio)
{
    // std::cerr << "SimpleChannelNoiseDB: set pad window back on " << channels.size() << " channels: " << pad_b <<
    // std::endl;
    for (auto ch : channels) {
        int ind = chind(ch);
        set_one(ind, roi_min_max_ratio, m_roi_min_max_ratio, m_default_roi_min_max_ratio);
    }
}

void SimpleChannelNoiseDB::set_filter(const std::vector<int>& channels, const multimask_t& masks)
{
    Waveform::compseq_t spectrum;
    spectrum.resize(m_nsamples, std::complex<float>(1, 0));

    for (auto m : masks) {
        for (int ind = get<1>(m); ind <= get<2>(m); ++ind) {
            // filt->assign(ind, get<0>(m));
            spectrum.at(ind) = get<0>(m);
        }
        // std::cerr << "set freqmasks: " << get<1>(m) << " " << get<2>(m) << " " << get<0>(m) << " " << spectrum.at(0)
        // << " " << spectrum.at(169) << " " << spectrum.at(170)<< std::endl;
    }
    auto filt = std::make_shared<filter_t>(spectrum);

    for (auto ch : channels) {
        set_one(chind(ch), filt, m_masks, m_default_filter);
    }
}

void SimpleChannelNoiseDB::set_channel_groups(const std::vector<channel_group_t>& channel_groups)
{
    // std::cerr << "SimpleChannelNoiseDB: channel groups: " << channel_groups.size() << " X " <<
    // channel_groups[0].size() << std::endl;
    m_channel_groups = channel_groups;
}

void SimpleChannelNoiseDB::set_bad_channels(const channel_group_t& bc)
{
    // std::cerr << "SimpleChannelNoiseDB:: bad channels: " << bc.size() << std::endl;
    m_bad_channels = bc;
}

int SimpleChannelNoiseDB::chind(int ch) const
{
    auto it = m_ch2ind.find(ch);
    if (it == m_ch2ind.end()) {
        int ind = m_ch2ind.size();
        m_ch2ind[ch] = ind;
        return ind;
    }
    return it->second;
}

// Local Variables:
// mode: c++
// c-basic-offset: 4
// End:
