yoda/techmodel/EventReader.cpp

/** @file
 * $Author: kusanagi $
 * $Date: 2004/12/22 11:38:35 $
 * $Revision: 2.7 $
 * 
 * Implementation of the functions of a sample Algorithm class.
 * This file can be used as a templace to develop your own algorithm.
 */

#include <log4cxx/logger.h>
#include <fstream>
#include "EventReader.h"
#include "ReaderAlgorithms.h"


extern "C" {
    #include "CRC.h"
}

using namespace pamela;
using namespace pamela::techmodel;

static log4cxx::LoggerPtr logger = log4cxx::Logger::getLogger(_T("pamela.techmodel.EventReader"));

unsigned int EventReader::maxPackets     = 0;
unsigned int EventReader::prevPckCounter = 0;
unsigned int EventReader::prevPckOBT     = 0;


/**
 * Constructor. 
 */
EventReader::EventReader(int packetsLimit = -1): 
  TechmodelAlgorithm(0, "TechmodelEventReader"){ 
  EventReader::maxPackets = packetsLimit;
  logger->debug(_T("Constructor"));
  Header = new EventHeader();

  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::PhysEndRun,      new PhysEndRunReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibCalPulse1,  new CalibCalPulse1Reader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibCalPulse2,  new CalibCalPulse2Reader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Physics,         new PhysicsReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTrkBoth,    new CalibTrkBothReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTrk1,       new CalibTrk1Reader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTrk2,       new CalibTrk2Reader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTrd,        new CalibTrdReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTof,        new CalibTofReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibS4,         new CalibS4Reader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibCalPed,     new CalibCalPedReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Calib1_Ac1,      new Calib1_Ac1Reader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Calib2_Ac1,      new Calib2_Ac1Reader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Calib1_Ac2,      new Calib1_Ac2Reader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Calib2_Ac2,      new Calib2_Ac2Reader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::RunHeader,       new RunHeaderReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::RunTrailer,      new RunTrailerReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibHeader,     new CalibHeaderReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTrailer,    new CalibTrailerReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::InitHeader,      new InitHeaderReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::InitTrailer,     new InitTrailerReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::EventTrk,        new EventTrkReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TestTrk,         new TestTrkReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TestTof,         new TestTofReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Log,             new LogReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::VarDump,         new VarDumpReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::ArrDump,         new ArrDumpReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TabDump,         new TabDumpReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Tmtc,            new TmtcReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Mcmd,            new McmdReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::ForcedFECmd,     new ForcedFECmdReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Ac1Init,         new Ac1InitReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalInit,         new CalInitReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TrkInit,         new TrkInitReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TofInit,         new TofInitReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TrgInit,         new TrgInitReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::NdInit,          new NdInitReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::S4Init,          new S4InitReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Ac2Init,         new Ac2InitReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalAlarm,        new CalAlarmReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::AcAlarm,         new AcAlarmReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TrkAlarm,        new TrkAlarmReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TrgAlarm,        new TrgAlarmReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TofAlarm,        new TofAlarmReader));
  TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::S4Alarm,         new S4AlarmReader));
}

/**
 * Get a string with the version info of the algorithm.
 */
std::string EventReader::GetVersionInfo(void) const {
  return 
    "$Header: /home/cvsmanager/yoda/techmodel/EventReader.cpp,v 2.7 2004/12/22 11:38:35 kusanagi Exp $\n";
}

/**
 * Initialize the algorithm with a special run. This will initialize the
 * event reader routines for all packet types.
 */
void EventReader::Init(PamelaRun *run) {
    SetInputStream(run);
    
    //Create the structure of directories and create xxx.Header.root files
    run->WriteHeaders(this, &Header); 

    //Create the xxx.root in it's specific directory
    for (AlgorithmMap::iterator i = TechmodelAlgorithmMap.begin(); 
       i != TechmodelAlgorithmMap.end(); i++) {
       oss.str("");
       oss << "Initializing algo " << i->second->GetAlgorithmName();
       logger->debug(oss.str().c_str());
       i->second->Init(run);
    }
    Run = dynamic_cast<TechmodelPamelaRun*>(run);
}

static void SkipToNextHeader(ifstream *);

/**
 * Read the next event header, call the reader algorithms that
 * correspond to its packet type, and read the event trailer.
 */

// 15 June 2004 ---note------------------
// A nice refacoring would require to not read again the packet data (which is
// read in the UnpackPscuHeader() and put directly in  the
// EventAlgorithm->RunEvent(....) directly the data inside the packet.... will see later....
// 15 June 2004 ---note------------------
void EventReader::RunEvent(int EventNumber) {
  //for now i'll suppose that the raw file starts immediately with the right bytes
  //to insert a GetPacketStart()
  stringstream oss;
  int step = 0;
  const PacketType* type;
  while (!InputFile->eof() && ((step++ < maxPackets) || (maxPackets == 0))){
    try {
      if (FindStart()) {
            UnpackPscuHeader();
            type = Header->GetPscuHeader()->GetPacketType();
            AlgorithmMap::iterator i = TechmodelAlgorithmMap.find(type); 
            if (i != TechmodelAlgorithmMap.end()) {
                TechmodelAlgorithm *EventAlgorithm(i->second);
                EventAlgorithm->RunEvent(EventNumber, Header->GetPscuHeader()->GetPacketLenght());
                Run->FillTrees(type);
                Header->GetCounter()->Increment(type);
                logger->info(Header->GetPscuHeader()->Print());
            } else {
                oss.str("");
                oss << "\n No way to read events of type  " << type->GetName().c_str() << Header->GetPscuHeader()->Print();
                throw NotExistingAlgorithmException(oss.str().c_str()); //to exctract to an higher level and delete the logger!
            }
      }
    // In case of exception have to save the packet in a specific root file??
    } catch (NotExistingAlgorithmException exc) {
      oss.str("");
      oss << exc.print() << " " << Header->GetPscuHeader()->Print();
      logger->error(oss.str().c_str());
    } catch (WrongCRCHeaderException exc) {
      oss.str("");
      oss << exc.print();
      logger->error(oss.str().c_str());
    } catch (WrongCRCException exc) {
      oss.str("");
      oss << exc.print() << " " << Header->GetPscuHeader()->Print();
      logger->error(oss.str().c_str());
    } catch (UnidentifiedPacketException exc) {
      oss.str("");
      oss << exc.print() << " " << Header->GetPscuHeader()->Print();
      logger->error(oss.str().c_str());
    } catch (NotExistingCounterException exc) {
      oss.str("");
      oss << exc.print() << " " << Header->GetPscuHeader()->Print();
      logger->error(oss.str().c_str());
    } catch (LengthException exc) {
      oss.str("");
      oss << exc.print() << " " << Header->GetPscuHeader()->Print();
      logger->error(oss.str().c_str());
    } catch (...) {
      logger->error("Couldn't read the event. Skipping to the next header. \n");
    }
    if ((step%1000) == 0) std::cout << step/1000 << "K \n";
  }
    Header->GetCounter()->PrintCounters();
}

static void SkipToNextHeader(ifstream* TechmodelFile) {
  //  yeah.
}


/**
 * Unpack the PSCU header from a file into the structure.
 */
void EventReader::UnpackPscuHeader(void) throw (WrongCRCHeaderException, LengthException) {
  stringstream oss;
  int response = false;
  char buff[16];
  InputFile->read(buff, sizeof(buff));
  
  
  unsigned char PacketId1    = buff[3];
  unsigned char PacketId2    = buff[4];
  unsigned int  Counter      = (((UINT32)buff[5]<<16)&0x00FF0000) + (((UINT32)buff[6]<<8)&0x0000FF00) + (((UINT32)buff[7])&0x000000FF);
  unsigned int  OrbitalTime  = (((UINT32)buff[8]<<24)&0xFF000000) + (((UINT32)buff[9]<<16)&0x00FF0000) +  (((UINT32)buff[10]<<8)&0x0000FF00) + (((UINT32)buff[11])&0x000000FF);
  unsigned int  PacketLenght = (((UINT32)buff[12]<<16)&0x00FF0000) +  (((UINT32)buff[13]<<8)&0x0000FF00) + (((UINT32)buff[14])&0x000000FF);
  unsigned char CRC          = buff[15];
  unsigned char FileOffset   = buff[15];

  if (Counter < prevPckCounter){
    oss.str("");
    oss << "Packet counter is less than before of " << (prevPckCounter - Counter);
    logger->warn(oss.str().c_str());
  }

  if (OrbitalTime < prevPckOBT){
    oss.str("");
    oss << " Onboard Time is less than before of " << (prevPckOBT - OrbitalTime);
    logger->warn(oss.str().c_str());
  }

  if (((BYTE)CM_Compute_CRC16(0, (BYTE*)&buff, 15) == (BYTE)buff[15]) && (PacketId1 == PacketId2)){
    prevPckCounter = Counter;
    prevPckOBT     = OrbitalTime;
    long int initPos = InputFile->tellg();
    long int finalPos;
    Header->GetPscuHeader()->SetPacketId(PacketId1, PacketId2);
    Header->GetPscuHeader()->SetCounter(Counter);
    Header->GetPscuHeader()->SetOrbitalTime(OrbitalTime);
    //PacketLength is the length of the whole DATApacket starting from the first byte after the header
    //plus the CRC legth (which varies for each type of packet)
    Header->GetPscuHeader()->SetPacketLenght(PacketLenght);
    Header->GetPscuHeader()->SetCRC(CRC);
    Header->GetPscuHeader()->SetFileOffset(((long int)(InputFile->tellg()) - 16));
    
    //commented out because of the above test code
    InputFile->seekg(Header->GetPscuHeader()->GetPacketLenght(), std::ios::cur);
    if (FindStart()) {
        finalPos =  (long int)InputFile->tellg() - (initPos + (long int)(Header->GetPscuHeader()->GetPacketLenght()));
        if(finalPos == 0){
            logger->debug(_T(" Correct packet length"));
            } 
        if (finalPos > 0 && finalPos < 64) {
            oss.str("");
            oss << " Correct packet length: Padded of " << finalPos << " bytes";
            logger->debug(oss.str().c_str());
        } 
        if (finalPos > 64){
            oss.str("");
            oss << " The begin of the next packet is far more than 64 byte from the end of the previous." 
                << Header->GetPscuHeader()->Print();
            logger->error(oss.str().c_str());
            //throw LengthException("The begin of the next packet is far more than 64 byte from the end of the previous.");
        }
    }
    else {
        logger->debug(_T(" END OF FILE"));        
    }
        
        InputFile->seekg(initPos, std::ios::beg);
  } else {
     /*Here i should extract the block of Data for later analysis */
    InputFile->seekg(-(13), std::ios::cur);
    oss.str("");
    oss << "CRC Header Error on packet:" << PscuHeader::Print(buff);
    throw WrongCRCHeaderException(oss.str().c_str());
  }

/*    char tmpId1[4];
    char tmpId2[4];
    char tmpLength[12];
    char tmpStart[100];
    char tmpCRC[4];
    sprintf(tmpId1, "%02X", PacketId1);
    sprintf(tmpId2, "%02X", PacketId2);
    sprintf(tmpLength, "%06X", Header->GetPscuHeader()->GetPacketLenght());
    sprintf(tmpStart, "%X", Header->GetPscuHeader()->GetFileOffset());
    sprintf(tmpCRC, "%02X", CRC);
    oss.flush();
    oss << "\n Packet Counter (decimal) : "  <<  Counter
        <<  "\n Id1 - Id2                : "  <<  tmpId1 <<  " - " <<  tmpId2
        <<  "\n Orbital Time (decimal)   : "  <<  OrbitalTime
        <<  "\n Lenght                   : "  <<  tmpLength
        <<  "\n CRC                      : "  <<  tmpCRC
        <<  "\n Header Start Position    : "  <<  tmpStart;
    logger->info(oss.str().c_str());
*/
}

/**
 * Unpack the trailer of a PSCU event into the structure.
 */
void EventReader::UnpackPscuTrailer(void) throw (std::exception) {

}

/**
 * Find the next starting poin for the PSCU event looking for a {0xFA, 0xFE, 0xDE} sequence
 */
bool EventReader::FindStart(void) throw (std::exception) {
//search an hexadecimal sequence in a file
//subSign    ------> pointer to the sequence buffer
//subSignDim ------> dimension of the buffer
// at exit
// return true if founds a match (else false)
// subF point rigth after the match, if found. Else EOF.
//Maurizio 15/11/2002-----------------------
  const int subSignDim = 3;
  const unsigned char subSign[subSignDim]={0xFA, 0xFE, 0xDE};
//------------------------------------------
  int subIndex = 0;
  char dataByte;

  int  buffSize = 100;
  int  index = 0;
  int  loop = -1;
  char buffer[buffSize];

  while (!InputFile->eof()) {
    InputFile->read(buffer, sizeof(buffer));
    index = 0;
    loop++;
    while (index < buffSize){
        dataByte = buffer[index++];
        if (dataByte == (char)(*(subSign+subIndex))){
            if (subIndex++ == (subSignDim-1)) {
                InputFile->seekg( (index - (subIndex + buffSize)), std::ios::cur);
                return true;
            } 
        } else {
            index = index - (subIndex);
            subIndex = 0;
        }
    }
    //Needs to guarantee the overap of the buffer(s) in several loop
    InputFile->seekg( (-1)*(subSignDim + 1) , std::ios::cur);
  }
  return false;
} 

ClassImp(EventReader)
1	kusanagi	1.1	/** @file
2	kusanagi	1.2	* $Author: kusanagi $
3	kusanagi	2.8	* $Date: 2004/12/22 11:38:35 $
4			* $Revision: 2.7 $
5	kusanagi	1.1	*
6			* Implementation of the functions of a sample Algorithm class.
7			* This file can be used as a templace to develop your own algorithm.
8			*/
9
10	kusanagi	1.10	#include <log4cxx/logger.h>
11	kusanagi	1.1	#include <fstream>
12			#include "EventReader.h"
13			#include "ReaderAlgorithms.h"
14	kusanagi	2.4
15
16	kusanagi	1.1	extern "C" {
17	kusanagi	2.4	#include "CRC.h"
18	kusanagi	1.1	}
19
20			using namespace pamela;
21			using namespace pamela::techmodel;
22
23	kusanagi	1.10	static log4cxx::LoggerPtr logger = log4cxx::Logger::getLogger(_T("pamela.techmodel.EventReader"));
24
25			unsigned int EventReader::maxPackets = 0;
26	kusanagi	1.7	unsigned int EventReader::prevPckCounter = 0;
27			unsigned int EventReader::prevPckOBT = 0;
28	kusanagi	1.10
29
30	kusanagi	1.1	/**
31			* Constructor.
32			*/
33	kusanagi	1.10	EventReader::EventReader(int packetsLimit = -1):
34			TechmodelAlgorithm(0, "TechmodelEventReader"){
35			EventReader::maxPackets = packetsLimit;
36			logger->debug(_T("Constructor"));
37	kusanagi	1.1	Header = new EventHeader();
38	kusanagi	1.5
39	kusanagi	2.5	TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::PhysEndRun, new PhysEndRunReader));
40			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibCalPulse1, new CalibCalPulse1Reader));
41			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibCalPulse2, new CalibCalPulse2Reader));
42			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Physics, new PhysicsReader));
43			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTrkBoth, new CalibTrkBothReader));
44			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTrk1, new CalibTrk1Reader));
45			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTrk2, new CalibTrk2Reader));
46			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTrd, new CalibTrdReader));
47			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTof, new CalibTofReader));
48			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibS4, new CalibS4Reader));
49			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibCalPed, new CalibCalPedReader));
50	kusanagi	2.6	TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Calib1_Ac1, new Calib1_Ac1Reader));
51			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Calib2_Ac1, new Calib2_Ac1Reader));
52			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Calib1_Ac2, new Calib1_Ac2Reader));
53			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Calib2_Ac2, new Calib2_Ac2Reader));
54	kusanagi	2.5	TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::RunHeader, new RunHeaderReader));
55			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::RunTrailer, new RunTrailerReader));
56			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibHeader, new CalibHeaderReader));
57			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTrailer, new CalibTrailerReader));
58			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::InitHeader, new InitHeaderReader));
59			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::InitTrailer, new InitTrailerReader));
60			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::EventTrk, new EventTrkReader));
61			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TestTrk, new TestTrkReader));
62			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TestTof, new TestTofReader));
63			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Log, new LogReader));
64			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::VarDump, new VarDumpReader));
65			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::ArrDump, new ArrDumpReader));
66			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TabDump, new TabDumpReader));
67			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Tmtc, new TmtcReader));
68			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Mcmd, new McmdReader));
69			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::ForcedFECmd, new ForcedFECmdReader));
70	kusanagi	2.6	TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Ac1Init, new Ac1InitReader));
71	kusanagi	2.5	TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalInit, new CalInitReader));
72			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TrkInit, new TrkInitReader));
73			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TofInit, new TofInitReader));
74			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TrgInit, new TrgInitReader));
75			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::NdInit, new NdInitReader));
76			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::S4Init, new S4InitReader));
77	kusanagi	2.6	TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Ac2Init, new Ac2InitReader));
78	kusanagi	2.5	TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalAlarm, new CalAlarmReader));
79			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::AcAlarm, new AcAlarmReader));
80			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TrkAlarm, new TrkAlarmReader));
81			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TrgAlarm, new TrgAlarmReader));
82			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TofAlarm, new TofAlarmReader));
83			TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::S4Alarm, new S4AlarmReader));
84	kusanagi	1.1	}
85
86			/**
87			* Get a string with the version info of the algorithm.
88			*/
89			std::string EventReader::GetVersionInfo(void) const {
90			return
91	kusanagi	2.8	"$Header: /home/cvsmanager/yoda/techmodel/EventReader.cpp,v 2.7 2004/12/22 11:38:35 kusanagi Exp $\n";
92	kusanagi	1.1	}
93
94			/**
95			* Initialize the algorithm with a special run. This will initialize the
96			* event reader routines for all packet types.
97			*/
98			void EventReader::Init(PamelaRun *run) {
99			SetInputStream(run);
100
101			//Create the structure of directories and create xxx.Header.root files
102			run->WriteHeaders(this, &Header);
103
104			//Create the xxx.root in it's specific directory
105			for (AlgorithmMap::iterator i = TechmodelAlgorithmMap.begin();
106			i != TechmodelAlgorithmMap.end(); i++) {
107	kusanagi	2.4	oss.str("");
108	kusanagi	1.10	oss << "Initializing algo " << i->second->GetAlgorithmName();
109			logger->debug(oss.str().c_str());
110	kusanagi	1.1	i->second->Init(run);
111			}
112			Run = dynamic_cast<TechmodelPamelaRun*>(run);
113			}
114
115			static void SkipToNextHeader(ifstream *);
116
117			/**
118			* Read the next event header, call the reader algorithms that
119			* correspond to its packet type, and read the event trailer.
120			*/
121
122			// 15 June 2004 ---note------------------
123			// A nice refacoring would require to not read again the packet data (which is
124	kusanagi	2.4	// read in the UnpackPscuHeader() and put directly in the
125	kusanagi	1.1	// EventAlgorithm->RunEvent(....) directly the data inside the packet.... will see later....
126			// 15 June 2004 ---note------------------
127			void EventReader::RunEvent(int EventNumber) {
128			//for now i'll suppose that the raw file starts immediately with the right bytes
129			//to insert a GetPacketStart()
130	kusanagi	1.10	stringstream oss;
131			int step = 0;
132	kusanagi	2.5	const PacketType* type;
133	kusanagi	1.10	while (!InputFile->eof() && ((step++ < maxPackets) \|\| (maxPackets == 0))){
134	kusanagi	1.1	try {
135			if (FindStart()) {
136	kusanagi	2.4	UnpackPscuHeader();
137	kusanagi	2.5	type = Header->GetPscuHeader()->GetPacketType();
138	kusanagi	1.1	AlgorithmMap::iterator i = TechmodelAlgorithmMap.find(type);
139			if (i != TechmodelAlgorithmMap.end()) {
140	kusanagi	2.5	TechmodelAlgorithm *EventAlgorithm(i->second);
141	kusanagi	1.1	EventAlgorithm->RunEvent(EventNumber, Header->GetPscuHeader()->GetPacketLenght());
142			Run->FillTrees(type);
143			Header->GetCounter()->Increment(type);
144	kusanagi	2.4	logger->info(Header->GetPscuHeader()->Print());
145	kusanagi	1.1	} else {
146	kusanagi	2.8	oss.str("");
147			oss << "\n No way to read events of type " << type->GetName().c_str() << Header->GetPscuHeader()->Print();
148			throw NotExistingAlgorithmException(oss.str().c_str()); //to exctract to an higher level and delete the logger!
149	kusanagi	2.3	}
150			}
151	kusanagi	2.4	// In case of exception have to save the packet in a specific root file??
152			} catch (NotExistingAlgorithmException exc) {
153	kusanagi	2.5	oss.str("");
154			oss << exc.print() << " " << Header->GetPscuHeader()->Print();
155			logger->error(oss.str().c_str());
156	kusanagi	2.4	} catch (WrongCRCHeaderException exc) {
157	kusanagi	2.5	oss.str("");
158	kusanagi	2.8	oss << exc.print();
159	kusanagi	2.5	logger->error(oss.str().c_str());
160	kusanagi	2.4	} catch (WrongCRCException exc) {
161	kusanagi	2.5	oss.str("");
162			oss << exc.print() << " " << Header->GetPscuHeader()->Print();
163			logger->error(oss.str().c_str());
164	kusanagi	2.4	} catch (UnidentifiedPacketException exc) {
165	kusanagi	2.5	oss.str("");
166			oss << exc.print() << " " << Header->GetPscuHeader()->Print();
167			logger->error(oss.str().c_str());
168	kusanagi	2.4	} catch (NotExistingCounterException exc) {
169	kusanagi	2.5	oss.str("");
170			oss << exc.print() << " " << Header->GetPscuHeader()->Print();
171			logger->error(oss.str().c_str());
172	kusanagi	2.4	} catch (LengthException exc) {
173	kusanagi	2.5	oss.str("");
174			oss << exc.print() << " " << Header->GetPscuHeader()->Print();
175			logger->error(oss.str().c_str());
176	kusanagi	1.1	} catch (...) {
177	kusanagi	2.4	logger->error("Couldn't read the event. Skipping to the next header. \n");
178	kusanagi	1.1	}
179	kusanagi	2.1	if ((step%1000) == 0) std::cout << step/1000 << "K \n";
180	kusanagi	1.1	}
181	kusanagi	1.10	Header->GetCounter()->PrintCounters();
182	kusanagi	1.1	}
183
184			static void SkipToNextHeader(ifstream* TechmodelFile) {
185			// yeah.
186			}
187
188
189
190			/**
191			* Unpack the PSCU header from a file into the structure.
192			*/
193	kusanagi	2.8	void EventReader::UnpackPscuHeader(void) throw (WrongCRCHeaderException, LengthException) {
194	kusanagi	1.10	stringstream oss;
195	kusanagi	2.4	int response = false;
196	kusanagi	1.1	char buff[16];
197			InputFile->read(buff, sizeof(buff));
198
199
200			unsigned char PacketId1 = buff[3];
201			unsigned char PacketId2 = buff[4];
202			unsigned int Counter = (((UINT32)buff[5]<<16)&0x00FF0000) + (((UINT32)buff[6]<<8)&0x0000FF00) + (((UINT32)buff[7])&0x000000FF);
203			unsigned int OrbitalTime = (((UINT32)buff[8]<<24)&0xFF000000) + (((UINT32)buff[9]<<16)&0x00FF0000) + (((UINT32)buff[10]<<8)&0x0000FF00) + (((UINT32)buff[11])&0x000000FF);
204			unsigned int PacketLenght = (((UINT32)buff[12]<<16)&0x00FF0000) + (((UINT32)buff[13]<<8)&0x0000FF00) + (((UINT32)buff[14])&0x000000FF);
205			unsigned char CRC = buff[15];
206	kusanagi	1.9	unsigned char FileOffset = buff[15];
207	kusanagi	1.1
208			if (Counter < prevPckCounter){
209	kusanagi	2.4	oss.str("");
210	kusanagi	1.10	oss << "Packet counter is less than before of " << (prevPckCounter - Counter);
211	kusanagi	2.4	logger->warn(oss.str().c_str());
212	kusanagi	1.1	}
213
214			if (OrbitalTime < prevPckOBT){
215	kusanagi	2.4	oss.str("");
216			oss << " Onboard Time is less than before of " << (prevPckOBT - OrbitalTime);
217			logger->warn(oss.str().c_str());
218	kusanagi	1.1	}
219
220	kusanagi	1.7	if (((BYTE)CM_Compute_CRC16(0, (BYTE*)&buff, 15) == (BYTE)buff[15]) && (PacketId1 == PacketId2)){
221			prevPckCounter = Counter;
222			prevPckOBT = OrbitalTime;
223	kusanagi	1.1	long int initPos = InputFile->tellg();
224			long int finalPos;
225			Header->GetPscuHeader()->SetPacketId(PacketId1, PacketId2);
226			Header->GetPscuHeader()->SetCounter(Counter);
227			Header->GetPscuHeader()->SetOrbitalTime(OrbitalTime);
228			//PacketLength is the length of the whole DATApacket starting from the first byte after the header
229			//plus the CRC legth (which varies for each type of packet)
230			Header->GetPscuHeader()->SetPacketLenght(PacketLenght);
231			Header->GetPscuHeader()->SetCRC(CRC);
232	kusanagi	1.9	Header->GetPscuHeader()->SetFileOffset(((long int)(InputFile->tellg()) - 16));
233	kusanagi	1.1
234			//commented out because of the above test code
235			InputFile->seekg(Header->GetPscuHeader()->GetPacketLenght(), std::ios::cur);
236	kusanagi	2.7	if (FindStart()) {
237			finalPos = (long int)InputFile->tellg() - (initPos + (long int)(Header->GetPscuHeader()->GetPacketLenght()));
238	kusanagi	1.1	if(finalPos == 0){
239	kusanagi	2.7	logger->debug(_T(" Correct packet length"));
240	kusanagi	1.1	}
241			if (finalPos > 0 && finalPos < 64) {
242	kusanagi	2.4	oss.str("");
243	kusanagi	1.10	oss << " Correct packet length: Padded of " << finalPos << " bytes";
244	kusanagi	2.4	logger->debug(oss.str().c_str());
245	kusanagi	1.1	}
246			if (finalPos > 64){
247	kusanagi	2.4	oss.str("");
248	kusanagi	2.7	oss << " The begin of the next packet is far more than 64 byte from the end of the previous."
249	kusanagi	2.4	<< Header->GetPscuHeader()->Print();
250	kusanagi	2.5	logger->error(oss.str().c_str());
251	kusanagi	2.4	//throw LengthException("The begin of the next packet is far more than 64 byte from the end of the previous.");
252	kusanagi	1.1	}
253	kusanagi	2.7	}
254			else {
255			logger->debug(_T(" END OF FILE"));
256			}
257
258	kusanagi	1.1	InputFile->seekg(initPos, std::ios::beg);
259			} else {
260	kusanagi	2.8	/Here i should extract the block of Data for later analysis /
261	kusanagi	1.8	InputFile->seekg(-(13), std::ios::cur);
262	kusanagi	2.8	oss.str("");
263			oss << "CRC Header Error on packet:" << PscuHeader::Print(buff);
264			throw WrongCRCHeaderException(oss.str().c_str());
265	kusanagi	1.1	}
266	kusanagi	2.4
267			/* char tmpId1[4];
268	kusanagi	1.1	char tmpId2[4];
269			char tmpLength[12];
270			char tmpStart[100];
271			char tmpCRC[4];
272			sprintf(tmpId1, "%02X", PacketId1);
273			sprintf(tmpId2, "%02X", PacketId2);
274	kusanagi	1.4	sprintf(tmpLength, "%06X", Header->GetPscuHeader()->GetPacketLenght());
275	kusanagi	1.9	sprintf(tmpStart, "%X", Header->GetPscuHeader()->GetFileOffset());
276	kusanagi	1.1	sprintf(tmpCRC, "%02X", CRC);
277	kusanagi	1.10	oss.flush();
278			oss << "\n Packet Counter (decimal) : " << Counter
279	kusanagi	1.1	<< "\n Id1 - Id2 : " << tmpId1 << " - " << tmpId2
280			<< "\n Orbital Time (decimal) : " << OrbitalTime
281			<< "\n Lenght : " << tmpLength
282			<< "\n CRC : " << tmpCRC
283	kusanagi	1.10	<< "\n Header Start Position : " << tmpStart;
284			logger->info(oss.str().c_str());
285	kusanagi	2.4	*/
286	kusanagi	1.1	}
287
288			/**
289			* Unpack the trailer of a PSCU event into the structure.
290			*/
291			void EventReader::UnpackPscuTrailer(void) throw (std::exception) {
292
293			}
294
295			/**
296			* Find the next starting poin for the PSCU event looking for a {0xFA, 0xFE, 0xDE} sequence
297			*/
298	kusanagi	2.7	bool EventReader::FindStart(void) throw (std::exception) {
299	kusanagi	1.1	//search an hexadecimal sequence in a file
300			//subSign ------> pointer to the sequence buffer
301			//subSignDim ------> dimension of the buffer
302			// at exit
303			// return true if founds a match (else false)
304			// subF point rigth after the match, if found. Else EOF.
305			//Maurizio 15/11/2002-----------------------
306	kusanagi	2.4	const int subSignDim = 3;
307			const unsigned char subSign[subSignDim]={0xFA, 0xFE, 0xDE};
308	kusanagi	1.1	//------------------------------------------
309			int subIndex = 0;
310			char dataByte;
311	kusanagi	1.10
312			int buffSize = 100;
313			int index = 0;
314	kusanagi	2.4	int loop = -1;
315	kusanagi	1.10	char buffer[buffSize];
316
317			while (!InputFile->eof()) {
318			InputFile->read(buffer, sizeof(buffer));
319			index = 0;
320	kusanagi	2.4	loop++;
321	kusanagi	1.10	while (index < buffSize){
322			dataByte = buffer[index++];
323			if (dataByte == (char)(*(subSign+subIndex))){
324			if (subIndex++ == (subSignDim-1)) {
325	kusanagi	2.4	InputFile->seekg( (index - (subIndex + buffSize)), std::ios::cur);
326	kusanagi	2.7	return true;
327	kusanagi	2.4	}
328	kusanagi	1.10	} else {
329	kusanagi	2.4	index = index - (subIndex);
330	kusanagi	1.10	subIndex = 0;
331			}
332			}
333	kusanagi	2.4	//Needs to guarantee the overap of the buffer(s) in several loop
334			InputFile->seekg( (-1)*(subSignDim + 1) , std::ios::cur);
335	kusanagi	2.7	}
336			return false;
337	kusanagi	1.1	}
338
339			ClassImp(EventReader)