// StandardAdcWireBuildingService_service.cc

#include "StandardAdcWireBuildingService.h"
#include <iostream>
#include <sstream>
#include <iomanip>
#include "art/Framework/Services/Registry/ServiceHandle.h"
#include "lardata/ArtDataHelper/WireCreator.h"
#include "lardataobj/RawData/RawDigit.h"

using std::vector;
using std::string;
using std::ostream;
using std::cout;
using std::endl;
using std::setw;
using art::ServiceHandle;

//**********************************************************************

StandardAdcWireBuildingService::
StandardAdcWireBuildingService(fhicl::ParameterSet const& pset, art::ActivityRegistry&)
: m_LogLevel(1) {
  const string myname = "StandardAdcWireBuildingService::ctor: ";
  pset.get_if_present<int>("LogLevel", m_LogLevel);
  if ( m_LogLevel > 0 ) print(cout, myname);
  m_SaveChanPedRMS = false;
  pset.get_if_present<bool>("SaveChanPedRMS", m_SaveChanPedRMS);
}

//**********************************************************************

int StandardAdcWireBuildingService::build(AdcChannelData& data, WireVector* pwires) const {
  const string myname = "StandardAdcWireBuildingService:build: ";
  if ( m_LogLevel >= 2 ) cout << myname << "Building recob::Wire for channel "
                              << data.channel() << "." << endl;
  if ( data.wire != nullptr ) {
    cout << myname << "WARNING: Wire already exists for channel " << data.channel()
                   << ". No action taken." << endl;
    return 1;
  }
  if ( data.digit == nullptr ) {
    cout << myname << "WARNING: No digit is specified for channel " << data.channel()
                   << ". No action taken." << endl;
    return 2;
  }
  if ( data.digit->Channel() != data.channel() ) {
    cout << myname << "WARNING: Input data channel differs from digit: " << data.channel()
         << " != " << data.digit->Channel() << ". No action taken." << endl;
    return 3;
  }
  if ( data.samples.size() == 0 ) {
    cout << myname << "WARNING: Channel " << data.channel() << " has no samples." << endl;
    return 4;
  }
  if ( m_LogLevel >= 2 ) {
    cout << myname << "  Channel " << data.channel() << " has " << data.rois.size() << " ROI"
         << (data.rois.size()==1 ? "" : "s") << "." << endl;
  }
  
  // Create recob ROIs.
  recob::Wire::RegionsOfInterest_t recobRois;
  unsigned int lastROI = 0;
  for ( const AdcRoi& roi : data.rois ) {
    AdcSignalVector sigs;
    lastROI = roi.second;
    for ( unsigned int isig=roi.first; isig<=roi.second; ++isig ) {
      sigs.push_back(data.samples[isig]);
    }
    recobRois.add_range(roi.first, std::move(sigs));
  }
  if(m_SaveChanPedRMS) {
    // save a short ROI that only has the noise rms outside of the ROIs
    double sum = 0;
    double sum2 = 0;
    double cnt = 0;
    for(unsigned int isig = 0; isig < data.samples.size(); ++isig) {
      bool inROI = false;
      for(const auto& roi : data.rois) {
        if(isig >= roi.first && isig <= roi.second) {
          inROI = true;
          break;
        } // inside ROI?
      }  // roi
      if(inROI) continue;
      if(data.samples[isig] == 0) continue;
      sum += data.samples[isig];
      sum2 += data.samples[isig] * data.samples[isig];
      ++cnt;
//      if(cnt == 100) break;
    } // isig
    double rms = 1;
    double ped = 0;
    if(cnt > 0) {
      ped = sum / cnt;
      double arg = sum2 - cnt * ped * ped;
      if(arg > 0) rms = sqrt(arg / (cnt - 1));
    }
    AdcSignalVector sig1(1);
    sig1[0] = rms;
    lastROI += 10;
    recobRois.add_range(lastROI, std::move(sig1));
  }

  // Create recob::Wire.
  recob::WireCreator wc(std::move(recobRois), *data.digit);
  // Record the new wire if there is a wire container and if there is at least one ROI.
  bool dataOwnsWire = (pwires == nullptr) || (data.rois.size() == 0);
  if ( ! dataOwnsWire ) {
    if ( pwires->size() == pwires->capacity() ) {
      cout << myname << "ERROR: Wire vector capacity " << pwires->capacity()
           << " is too small. Wire is not recorded." << endl;
      dataOwnsWire = true;
    } else {
      data.wireIndex = pwires->size();
      pwires->push_back(wc.move());
      data.wire = &pwires->back();
      if ( m_LogLevel >= 3 )
        cout << myname << "  Channel " << data.channel() << " ROIs stored in container." << endl;
    }
  }
  if ( dataOwnsWire ) {
    // Data cannot own the wire because it would then have to depend on the Wire class in order
    // to delete the Wire.
    //data.wire = new recob::Wire(wc.move());
  }
  return 0;
}

//**********************************************************************

ostream& StandardAdcWireBuildingService::
print(ostream& out, string prefix) const {
  out << prefix << "StandardAdcWireBuildingService:" << endl;
  out << prefix << "    LogLevel: " << m_LogLevel << endl;
  return out;
}

//**********************************************************************

DEFINE_ART_SERVICE_INTERFACE_IMPL(StandardAdcWireBuildingService, AdcWireBuildingService)

//**********************************************************************
