onlinemonitor/spadicmonitor/TSpadicSource.cxx (r4864/r3724)

Go to the documentation of this file.

#include "TSpadicSource.h"

#include "TClass.h"
#include "TUrl.h"

#include "TGo4Log.h"
#include "TGo4UserSourceParameter.h"
#include "TGo4MbsEvent.h"
#include "TGo4EventErrorException.h"
#include "TGo4EventTimeoutException.h"
#include "TGo4EventEndException.h"

#ifdef ROC_WITHSPADIC

#include "roc/Board.h"
#include "dabc/timing.h"
#include "spadiclib.h"
#include "spadic/Message.h"

#endif

// class required only to use methods, which are available in TGo4MbsSource

TSpadicSource::TSpadicSource(TGo4UserSourceParameter* par) :
   TGo4EventSource(),
   fArg(),
   fFullId(0),
   fLib(0),
   fPackages(),
   fBoardId(1),
   fHitDelay(20),
   fTriggerPerSecond(0),
   fLastTrigger(0.)

{
   fArg = par->GetName();

   Open();
}

TSpadicSource::TSpadicSource() :
   TGo4EventSource(),
   fArg(),
   fFullId(0),
   fLib(0),
   fPackages(),
   fBoardId(1),
   fHitDelay(20)
{
}


TSpadicSource::~TSpadicSource()
{
   Close();
}

Bool_t TSpadicSource::CheckEventClass(TClass* cl)
{
   return cl->InheritsFrom(TGo4MbsEvent::Class());
}

#ifdef ROC_WITHSPADIC

Bool_t TSpadicSource::BuildEvent(TGo4EventElement* dest)
{
   if (fLib==0) throw TGo4EventErrorException(this);

   dabc::TimeStamp start = dabc::Now();
   dabc::TimeStamp now = start;

   while ((now - start) < 10.) {

      now = dabc::Now();

      if (fTriggerPerSecond > 0)
         if ((now.AsDouble() - fLastTrigger) > 1./fTriggerPerSecond) {
            // DOUT3(("SusiboInput:: sending test trigger %d, thrshld= %d", trigcounter, thrshld));
            fLib->write(0x11, 0x01); //negedge
            fLib->write(0x11, 0x00); //and back to 1
            fLastTrigger = now.AsDouble();
         }


      if (fPackages.size()==0) {
         fLib->readPackages(fPackages, 50);
//         if (fPackages.size()>0)
//            cout << "!!! Get events total count = " << fPackages.size() << endl;
      }

      if (fPackages.size()==0) continue;

      unsigned package_size = fPackages.front().size();

      if (sizeof(fMsgBuffer) < package_size) {
         TGo4Log::Error("Local buffer in TSpadicSource is too small, required is %u", package_size);
         throw TGo4EventErrorException(this);
      }

      for (unsigned nn = 0; nn < package_size; nn++)
         fMsgBuffer[nn] = fPackages.front()[nn];

      fPackages.pop_front();

      spadic::Message msg(fMsgBuffer);

      if (!msg.CheckMessage()) {
         TGo4Log::Error("Bad message format !!!");
         continue;
      }

      TGo4MbsEvent* mbs = (TGo4MbsEvent*) dest;

      mbs->SetCount(msg.GetEventIDNumber());

      return mbs->AddSubEvent(fFullId, (Short_t*) fMsgBuffer, package_size/sizeof(Short_t) + 2) != 0;
   }

   // if we were waiting too long, break execution
   throw TGo4EventTimeoutException(this);
   return false;
}


Int_t TSpadicSource::Open()
{
   TGo4Log::Info("Open SpadicSource %s", fArg.Data());

   TString buf = fArg;
   buf.ToUpper();
   if ((buf.Index("SUSIBO")==0) && (buf.Length()>6)) {
      fBoardId = 1;

      buf.Remove(0, 6);

      int cnt=0;

      while (cnt<buf.Length() && (buf[cnt]>='0') && (buf[cnt]<='9')) cnt++;

      if (cnt>0) {
         buf.Remove(cnt);
         fBoardId = buf.Atoi();
      }
   }

   TUrl url(fArg.Data(), kTRUE);
   url.ParseOptions();
   int v = url.GetIntValueFromOptions("trigger");
   if (v>0) fTriggerPerSecond = v;
   v = url.GetIntValueFromOptions("delay");
   if (v>=0) fHitDelay = v;
   v = url.GetIntValueFromOptions("testloop");

   fLib = new SuS::SpadicLib();

   TGo4Log::Info("Open SpadicSource Susibo:%d HitDelay:%d TriggerPerSec:%d", fBoardId, fHitDelay, fTriggerPerSecond);

   if (!fLib->connectSpadic(SuS::SpadicIO::Ftdi, true, true, fBoardId, fHitDelay)) {
      TGo4Log::Error("Cannot connect to Susibo board %d", fBoardId);
      delete fLib;
      fLib = 0;
      return -1;
   }

   fFullId = roc::proc_TRD_Spadic | (fBoardId << 16) | (spadic::Message::packageStruct << 24); //


   if (v>0) {
      // this is just for debugging purposes

      TGo4Log::Debug("Try test loop in the beginning");

      for (int cnt=0;cnt<v;cnt++) {
         dabc::Sleep(0.1);

         if (fLib) {

            fLib->write(0x11, 0x01); //negedge
            fLib->write(0x11, 0x00); //and back to 1

            fLib->readPackages(fPackages, 50);
         }

         TGo4Log::Debug("Loop = %d size = %u", cnt, fPackages.size());

      }

      TGo4Log::Debug("Test loop finished, result = %u", fPackages.size());
   }

   return 0;
}


Int_t TSpadicSource::Close()
{
   if(fLib) {
      fLib->disconnectSpadic();
      int timeout(1000);
      while (!fLib->isReady() && timeout-- > 0) dabc::Sleep(0.001);
      if(timeout <= 0) TGo4Log::Error("could not disconnect SPADIC %d, timeout", fBoardId);
      delete fLib;
      fLib = 0;
   }

   fFullId = 0;

   return 0;
}

#else

Bool_t TSpadicSource::BuildEvent(TGo4EventElement* dest)
{
   TGo4Log::Error("SPADIC source is not supported");
   throw TGo4EventErrorException(this);
   return kFALSE;
}

Int_t TSpadicSource::Open()
{
   TGo4Log::Error("SPADIC source is not supported");
   return -1;
}


Int_t TSpadicSource::Close()
{
   TGo4Log::Error("SPADIC source is not supported");
   return -1;
}


#endif