/[PAMELA software]/yoda/techmodel/EventReader.cpp
ViewVC logotype

Diff of /yoda/techmodel/EventReader.cpp

Parent Directory Parent Directory | Revision Log Revision Log | View Patch Patch

revision 6.7 by kusanagi, Wed Aug 16 13:15:23 2006 UTC revision 6.12 by mocchiut, Thu Nov 16 10:49:40 2006 UTC
# Line 1  Line 1 
1  /** @file  /** @file
2   * $Author: kusanagi $   * $Author: mocchiut $
3   * $Date: 2006/05/30 19:58:25 $   * $Date: 2006/11/14 15:41:41 $
4   * $Revision: 6.6 $   * $Revision: 6.11 $
5   *   *
6   * Implementation of the functions of a sample Algorithm class.   * Implementation of the functions of a sample Algorithm class.
7   * This file can be used as a templace to develop your own algorithm.   * This file can be used as a templace to develop your own algorithm.
# Line 48  EventReader::EventReader(int packetsLimi Line 48  EventReader::EventReader(int packetsLimi
48    TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Calib2_Ac1,      new Calib2_Ac1Reader));    TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Calib2_Ac1,      new Calib2_Ac1Reader));
49    TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Calib1_Ac2,      new Calib1_Ac2Reader));    TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Calib1_Ac2,      new Calib1_Ac2Reader));
50    TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Calib2_Ac2,      new Calib2_Ac2Reader));    TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Calib2_Ac2,      new Calib2_Ac2Reader));
51    TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibCal,        new CalibCalReader));    TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Calib2_Ac2,      new CalibCalReader));
52    TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::RunHeader,       new RunHeaderReader));    TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::RunHeader,       new RunHeaderReader));
53    TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::RunTrailer,      new RunTrailerReader));    TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::RunTrailer,      new RunTrailerReader));
54    TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibHeader,     new CalibHeaderReader));    TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibHeader,     new CalibHeaderReader));
# Line 87  EventReader::EventReader(int packetsLimi Line 87  EventReader::EventReader(int packetsLimi
87   */   */
88  std::string EventReader::GetVersionInfo(void) const {  std::string EventReader::GetVersionInfo(void) const {
89    return    return
90      "$Header: /home/cvsmanager/yoda/techmodel/EventReader.cpp,v 6.6 2006/05/30 19:58:25 kusanagi Exp $\n";      "$Header: /afs/ba.infn.it/user/pamela/src/CVS/yoda/techmodel/EventReader.cpp,v 6.11 2006/11/14 15:41:41 mocchiut Exp $\n";
91  }  }
92    
93  /**  /**
# Line 120  void EventReader::RunEvent(int EventNumb Line 120  void EventReader::RunEvent(int EventNumb
120    stringstream oss;    stringstream oss;
121    int step = 0;    int step = 0;
122    const PacketType* type;    const PacketType* type;
123    unsigned char *header;    while ( InputFile->good() && !InputFile->eof() && ((step++ < maxPackets) || (maxPackets == 0))){
   while (!InputFile->eof() && ((step++ < maxPackets) || (maxPackets == 0))){  
124      try {      try {
125        if (FindStart(*&header, 16)) {        if (FindStart()) {
126              UnpackPscuHeader(*&header);              UnpackPscuHeader();
127              type = Header->GetPscuHeader()->GetPacketType();              type = Header->GetPscuHeader()->GetPacketType();
128              AlgorithmMap::iterator i = TechmodelAlgorithmMap.find(type);              AlgorithmMap::iterator i = TechmodelAlgorithmMap.find(type);
129              if (i != TechmodelAlgorithmMap.end()) {              if (i != TechmodelAlgorithmMap.end()) {
# Line 138  void EventReader::RunEvent(int EventNumb Line 137  void EventReader::RunEvent(int EventNumb
137                  oss << "\n No way to read events of type  " << type->GetName().c_str() << Header->GetPscuHeader()->Print();                  oss << "\n No way to read events of type  " << type->GetName().c_str() << Header->GetPscuHeader()->Print();
138                  throw NotExistingAlgorithmException(oss.str().c_str()); //to exctract to an higher level and delete the logger!                  throw NotExistingAlgorithmException(oss.str().c_str()); //to exctract to an higher level and delete the logger!
139              }              }
140    
141                //
142                // E. Mocchiutti
143                //
144    
145                //
146                // Start reading the next event jumping the CPU padding to 64 bits
147                //      
148                Float_t pd0 = (16.+Header->GetPscuHeader()->GetPacketLenght())/64.;
149                Float_t pd1 =  pd0 - (Float_t)int(pd0);
150                Float_t padfrac = 64. - pd1 * 64.;
151                //
152                UInt_t padbytes = (UInt_t)padfrac;
153                if ( padbytes > 0 ){
154                  oss.str("");
155                  oss << " padbytes is " << padbytes << " \n skipping these bytes\n";
156                  logger->info(oss.str().c_str());
157                  InputFile->seekg(padbytes,std::ios::cur);
158                };
159    
160                //
161                // end E. Mocchiutti
162                //
163    
164        }        }
165      // In case of exception have to save the packet in a specific root file??      // In case of exception have to save the packet in a specific root file??
166      } catch (NotExistingAlgorithmException exc) {      } catch (NotExistingAlgorithmException exc) {
# Line 153  void EventReader::RunEvent(int EventNumb Line 176  void EventReader::RunEvent(int EventNumb
176        oss << exc.print() << " " << Header->GetPscuHeader()->Print();        oss << exc.print() << " " << Header->GetPscuHeader()->Print();
177        logger->error(oss.str().c_str());        logger->error(oss.str().c_str());
178        archiveCorruptedPacket(Header->GetPscuHeader()->FileOffset, Header->GetPscuHeader()->PacketLenght);        archiveCorruptedPacket(Header->GetPscuHeader()->FileOffset, Header->GetPscuHeader()->PacketLenght);
179          
180      } catch (UnidentifiedPacketException exc) {      } catch (UnidentifiedPacketException exc) {
181        oss.str("");        oss.str("");
182        oss << exc.print() << " " << Header->GetPscuHeader()->Print();        oss << exc.print() << " " << Header->GetPscuHeader()->Print();
# Line 177  void EventReader::RunEvent(int EventNumb Line 201  void EventReader::RunEvent(int EventNumb
201      oss << "----endPck " << Header->GetPscuHeader()->GetCounter() << "\n";      oss << "----endPck " << Header->GetPscuHeader()->GetCounter() << "\n";
202      logger->info(oss.str().c_str());      logger->info(oss.str().c_str());
203    }    }
204      if ( InputFile->fail() || InputFile->bad() ) printf(" ERROR READING RAW FILE! \n"); // E. Mocchiutti
205    
206      Header->GetCounter()->PrintCounters();      Header->GetCounter()->PrintCounters();
207      //if (corruptedPacketFile.is_open()) corruptedPacketFile.close();      //if (corruptedPacketFile.is_open()) corruptedPacketFile.close();
208  }  }
# Line 184  void EventReader::RunEvent(int EventNumb Line 210  void EventReader::RunEvent(int EventNumb
210  /**  /**
211   * Unpack the PSCU header from a file into the structure.   * Unpack the PSCU header from a file into the structure.
212   */   */
213  void EventReader::UnpackPscuHeader(unsigned char *header) throw (WrongCRCHeaderException, LengthException, BackwardCounterException) {  void EventReader::UnpackPscuHeader(void) throw (WrongCRCHeaderException, LengthException, BackwardCounterException) {
   if (header == NULL) throw LengthException("errore di lunghezza");  
214    stringstream oss;    stringstream oss;
215    int response = 0;    int response = 0;
216      char buff[16];
217      memset(buff,  0, 16*sizeof(char));
218      InputFile->read(buff, sizeof(buff));
219      
220      
221      unsigned char PacketId1    = buff[3];
222      unsigned char PacketId2    = buff[4];
223      unsigned int  Counter      = (((UINT32)buff[5]<<16)&0x00FF0000) + (((UINT32)buff[6]<<8)&0x0000FF00) + (((UINT32)buff[7])&0x000000FF);
224      unsigned int  OrbitalTime  = (((UINT32)buff[8]<<24)&0xFF000000) + (((UINT32)buff[9]<<16)&0x00FF0000) +  (((UINT32)buff[10]<<8)&0x0000FF00) + (((UINT32)buff[11])&0x000000FF);
225      unsigned int  PacketLenght = (((UINT32)buff[12]<<16)&0x00FF0000) +  (((UINT32)buff[13]<<8)&0x0000FF00) + (((UINT32)buff[14])&0x000000FF);
226      unsigned char CRC          = buff[15];
227      unsigned char FileOffset   = 0;
228    
229    
230    unsigned char PacketId1    = header[3];    if (Counter < prevPckCounter){
   unsigned char PacketId2    = header[4];  
   unsigned int  Counter      = (((UINT32)header[5]<<16)&0x00FF0000) + (((UINT32)header[6]<<8)&0x0000FF00) + (((UINT32)header[7])&0x000000FF);  
   unsigned int  OrbitalTime  = (((UINT32)header[8]<<24)&0xFF000000) + (((UINT32)header[9]<<16)&0x00FF0000) +  (((UINT32)header[10]<<8)&0x0000FF00) + (((UINT32)header[11])&0x000000FF);  
   unsigned int  PacketLenght = (((UINT32)header[12]<<16)&0x00FF0000) +  (((UINT32)header[13]<<8)&0x0000FF00) + (((UINT32)header[14])&0x000000FF);  
   unsigned char CRC          = header[15];  
   unsigned char FileOffset   = header[15];  
   
   long int initPos = InputFile->tellg();  
   // Check parameters anomalies. If initPos < 16 it is the first packet  
   // (supposing a correct starting packet!)  
   if ((Counter < prevPckCounter) && (initPos > 16)){  
231      response = prevPckCounter - Counter;      response = prevPckCounter - Counter;
232      //oss.str("");      //oss.str("");
233      //oss << "Packet counter is less than before of " << (prevPckCounter - Counter);      //oss << "Packet counter is less than before of " << (prevPckCounter - Counter);
# Line 208  void EventReader::UnpackPscuHeader(unsig Line 235  void EventReader::UnpackPscuHeader(unsig
235      //logger->error(oss.str().c_str());      //logger->error(oss.str().c_str());
236    }    }
237    
238    if ((Counter > prevPckCounter + 1) && (initPos > 16)){    if (Counter > prevPckCounter + 1){
239      oss.str("");      oss.str("");
240      oss << "Packet counter is greater than before of " << (Counter - prevPckCounter);      oss << "Packet counter is greater than before of " << (Counter - prevPckCounter);
241      logger->error(oss.str().c_str());      logger->error(oss.str().c_str());
242    }    }
243        
244    if ((OrbitalTime == prevPckOBT) && (PacketId1 == 0x10) && (initPos > 16)) {    if ((OrbitalTime == prevPckOBT) & (PacketId1 == 0x10)){
245      oss.str("");      oss.str("");
246      oss << "Onboard Time of this packet is equal to the previous packet OBT";      oss << "Onboard Time of this packet is equal to the previous packet OBT";
247      logger->error(oss.str().c_str());      logger->error(oss.str().c_str());
248      logger->error(Header->GetPscuHeader()->Print());      logger->error(Header->GetPscuHeader()->Print());
249    }    }
250    
251    if ((OrbitalTime < prevPckOBT) && (initPos > 16)) {    if (OrbitalTime < prevPckOBT){
252      oss.str("");      oss.str("");
253      oss << " Onboard Time is less than before of " << (prevPckOBT - OrbitalTime);      oss << " Onboard Time is less than before of " << (prevPckOBT - OrbitalTime);
254      logger->error(oss.str().c_str());      logger->error(oss.str().c_str());
255    }    }
256    
257    if ( ((BYTE)CM_Compute_CRC16(0, (BYTE*)header, 15) == (BYTE)header[15]) && (PacketId1 == PacketId2)){    if (((BYTE)CM_Compute_CRC16(0, (BYTE*)&buff, 15) == (BYTE)buff[15]) && (PacketId1 == PacketId2)){
258      prevPckCounter = Counter;      prevPckCounter = Counter;
259      prevPckOBT     = OrbitalTime;      prevPckOBT     = OrbitalTime;
260        long int initPos = InputFile->tellg();
261      long int finalPos;      long int finalPos;
262      Header->GetPscuHeader()->SetPacketId(PacketId1, PacketId2);      Header->GetPscuHeader()->SetPacketId(PacketId1, PacketId2);
263      Header->GetPscuHeader()->SetCounter(Counter);      Header->GetPscuHeader()->SetCounter(Counter);
# Line 238  void EventReader::UnpackPscuHeader(unsig Line 266  void EventReader::UnpackPscuHeader(unsig
266      //plus the CRC legth (which varies for each type of packet)      //plus the CRC legth (which varies for each type of packet)
267      Header->GetPscuHeader()->SetPacketLenght(PacketLenght);      Header->GetPscuHeader()->SetPacketLenght(PacketLenght);
268      Header->GetPscuHeader()->SetCRC(CRC);      Header->GetPscuHeader()->SetCRC(CRC);
269      Header->GetPscuHeader()->SetFileOffset(((long int)(InputFile->tellg()) - 16));      Header->GetPscuHeader()->SetFileOffset((unsigned long int)(InputFile->tellg() - 16));
270    } else {    } else {
271       //Here i should extract the block of Data for later analysis       /*Here i should extract the block of Data for later analysis */
272      InputFile->seekg(-(13), std::ios::cur);      InputFile->seekg(-(13), std::ios::cur);
273      oss.str("");      oss.str("");
274      oss << "CRC Header Error on packet:" << PscuHeader::Print((char*)header);      oss << "CRC Header Error on packet:" << PscuHeader::Print(buff);
275      throw WrongCRCHeaderException(oss.str().c_str());      throw WrongCRCHeaderException(oss.str().c_str());
276    }    }
277    
# Line 254  void EventReader::UnpackPscuHeader(unsig Line 282  void EventReader::UnpackPscuHeader(unsig
282    }    }
283  }  }
284    
   
285  /**  /**
286   * Unpack the trailer of a PSCU event into the structure.   * Unpack the trailer of a PSCU event into the structure.
287   */   */
# Line 262  void EventReader::UnpackPscuTrailer(void Line 289  void EventReader::UnpackPscuTrailer(void
289    
290  }  }
291    
 int EventReader::archiveCorruptedPacket(long int offset, long int length) {  
         if (!corruptedPacketFile.is_open()) {  
                 oss.str("");  
                 oss << Run->GetUnpackPath().c_str() << "Corrupted.dat";  
                 cout << oss.str().c_str() << "\n";  
                 cout << dec << offset << "\n";  
                 cout << dec << length << "\n";  
                 corruptedPacketFile.open(oss.str().c_str(), ios::out);  
         }  
         char *buffer = new char[length];  
         InputFile->seekg(offset, ios_base::beg );  
         InputFile->read(buffer, length);  
         corruptedPacketFile.write(buffer, length);  
         InputFile->seekg(offset + 1, ios_base::beg );  
 }  
   
292  /**  /**
293   * Find the next starting poin for the PSCU event looking for a {0xFA, 0xFE, 0xDE} sequence   * Find the next starting poin for the PSCU event looking for a {0xFA, 0xFE, 0xDE} sequence
294   */   */
295  bool EventReader::FindStart(unsigned char *header, long lenght) throw (std::exception) {  bool EventReader::FindStart(void) throw (std::exception) {
296  //search an hexadecimal sequence in a file  //search an hexadecimal sequence in a file
297  //subSign    ------> pointer to the sequence buffer  //subSign    ------> pointer to the sequence buffer
298  //subSignDim ------> dimension of the buffer  //subSignDim ------> dimension of the buffer
# Line 297  bool EventReader::FindStart(unsigned cha Line 308  bool EventReader::FindStart(unsigned cha
308    
309    int  buffSize = 64;    int  buffSize = 64;
310    int  index = 0;    int  index = 0;
311      int  loop = -1;
312    char buffer[buffSize];    char buffer[buffSize];
   char *offset;  
313    bool flagOverPad = false;    bool flagOverPad = false;
314      memset(buffer,  0, buffSize*sizeof(char));
315    while (!InputFile->eof()) {    while (!InputFile->eof()) {
316      InputFile->read(buffer, buffSize);      InputFile->read(buffer, sizeof(buffer));
317      index = 0;      index = 0;
318      offset = &buffer[0];      loop++;
319      while (index < buffSize - 3){      while (index < buffSize){
320          if (!(memcmp(offset, subSign, 3))){          dataByte = buffer[index++];
321                  InputFile->seekg(index - buffSize + 16, std::ios::cur);          if (dataByte == (char)(*(subSign+subIndex))){
322                  if (flagOverPad){              if (subIndex++ == (subSignDim-1)) {
323                          oss.str("");                  InputFile->seekg( (index - (subIndex + buffSize)), std::ios::cur);
324                          oss << "\n This packet beginning is farther than 64 byte from the end of the previous."                  if (flagOverPad){
325                          << "\n Below the is the last already unpacked packet";                      oss.str("");
326                          logger->error(oss.str().c_str());                      oss << "\n This packet beginning is farther than 64 byte from the end of the previous."
327                          logger->error(Header->GetPscuHeader()->Print());                          << "\n Below the is the last already unpacked packet";
328                  }                      logger->error(oss.str().c_str());
329                  memcpy(header, offset, lenght);                      logger->error(Header->GetPscuHeader()->Print());
330                  return true;                  }
331                    return true;
332                }
333            } else {
334                index = index - (subIndex);
335                subIndex = 0;
336          }          }
         index++;  
         offset++;  
337      }      }
338      //Needs to guarantee the overap of the buffer(s) in several loop      //Needs to guarantee the overap of the buffer(s) in several loop
339      flagOverPad = true;      flagOverPad = true;
340      InputFile->seekg( -3 , std::ios::cur);      InputFile->seekg( (-1)*(subSignDim + 1) , std::ios::cur);
341    }    }
342    return false;    return false;
343  }  }
344    
345    
346    int EventReader::archiveCorruptedPacket(long int offset, long int length) {
347            if (!corruptedPacketFile.is_open()) {
348                    oss.str("");
349                    oss << Run->GetUnpackPath().c_str() << "Corrupted.dat";
350                    cout << oss.str().c_str() << "\n";
351                    cout << dec << offset << "\n";
352                    cout << dec << length << "\n";
353                    corruptedPacketFile.open(oss.str().c_str(), ios::out);
354            }
355            char *buffer = new char[length];
356            InputFile->seekg(offset, ios_base::beg );
357            InputFile->read(buffer, length);
358            corruptedPacketFile.write(buffer, length);
359            InputFile->seekg(offset + 1, ios_base::beg );
360    }
361    
362  ClassImp(EventReader)  ClassImp(EventReader)
Legend:
Removed from v.6.7  
changed lines
  Added in v.6.12
  ViewVC Help
Powered by ViewVC 1.1.23