/[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.15 by mocchiut, Mon Nov 20 08:58:04 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/16 12:28:17 $
4   * $Revision: 6.6 $   * $Revision: 6.14 $
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.14 2006/11/16 12:28:17 mocchiut Exp $\n";
91  }  }
92    
93  /**  /**
# Line 98  void EventReader::Init(PamelaRun *run) { Line 98  void EventReader::Init(PamelaRun *run) {
98      SetInputStream(run);      SetInputStream(run);
99      //Create the structure of directories and create xxx.Header.root files      //Create the structure of directories and create xxx.Header.root files
100      run->WriteHeaders(this, &Header);      run->WriteHeaders(this, &Header);
101        fPL = 0;
102        notfirst = false;
103        jgood = true;
104      //Create the xxx.root in it's specific directory      //Create the xxx.root in it's specific directory
105      for (AlgorithmMap::iterator i = TechmodelAlgorithmMap.begin();      for (AlgorithmMap::iterator i = TechmodelAlgorithmMap.begin();
106         i != TechmodelAlgorithmMap.end(); i++) {         i != TechmodelAlgorithmMap.end(); i++) {
# Line 120  void EventReader::RunEvent(int EventNumb Line 122  void EventReader::RunEvent(int EventNumb
122    stringstream oss;    stringstream oss;
123    int step = 0;    int step = 0;
124    const PacketType* type;    const PacketType* type;
125    unsigned char *header;    while ( InputFile->good() && !InputFile->eof() && ((step++ < maxPackets) || (maxPackets == 0))){
   while (!InputFile->eof() && ((step++ < maxPackets) || (maxPackets == 0))){  
126      try {      try {
127        if (FindStart(*&header, 16)) {        if (FindStart()) {
128              UnpackPscuHeader(*&header);              UnpackPscuHeader();
129              type = Header->GetPscuHeader()->GetPacketType();              type = Header->GetPscuHeader()->GetPacketType();
130              AlgorithmMap::iterator i = TechmodelAlgorithmMap.find(type);              AlgorithmMap::iterator i = TechmodelAlgorithmMap.find(type);
131              if (i != TechmodelAlgorithmMap.end()) {              if (i != TechmodelAlgorithmMap.end()) {
# Line 138  void EventReader::RunEvent(int EventNumb Line 139  void EventReader::RunEvent(int EventNumb
139                  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();
140                  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!
141              }              }
142    
143                //
144                // E. Mocchiutti
145                //
146                //
147                // Start reading the next event jumping the CPU padding to 64 bits
148                //
149                if ( Header->GetPscuHeader()->GetPacketId1() == 0x10 ) notfirst = true;        
150                //
151                if ( !InputFile->eof() && notfirst ){
152                        const unsigned char fafe[3]={0xFA, 0xFE, 0xDE};
153                        char isfa[3];
154                        memset(isfa, 0, 3*sizeof(char));
155                        InputFile->read(isfa, sizeof(isfa));
156                        InputFile->seekg(-3,std::ios::cur);
157                        //
158                        fPL += 16 + Header->GetPscuHeader()->GetPacketLenght();
159                        //
160                        if ( (0x000000FF & isfa[0]) == fafe[0] && (0x000000FF & isfa[2]) == fafe[2] && (0x000000FF & isfa[2]) == fafe[2] ){
161                               //
162                               fPL += 0;
163                        } else {
164                                if ( !jgood ){
165                                        jgood = true;
166                                } else {
167                                        Float_t pd0 = fPL/64.;
168                                        fPL = 0;
169                                        Float_t pd1 = pd0 - (Float_t)int(pd0);
170                                        Float_t padfrac = 64. - pd1 * 64.;
171                                        //
172                                        UInt_t padbytes = (UInt_t)padfrac;
173                                        if ( padbytes > 0 && padbytes < 64 ){
174                                                  oss.str("");
175                                                  oss << " padbytes is " << padbytes << " \n skipping these bytes\n";
176                                                  logger->info(oss.str().c_str());
177                                                  InputFile->seekg(padbytes,std::ios::cur);
178                                        };
179                                };
180                        };
181                };
182                //
183                // end E. Mocchiutti
184                //
185    
186        }        }
187      // 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??
188      } catch (NotExistingAlgorithmException exc) {      } catch (NotExistingAlgorithmException exc) {
189        oss.str("");        oss.str("");
190        oss << exc.print() << " " << Header->GetPscuHeader()->Print();        oss << exc.print() << " " << Header->GetPscuHeader()->Print();
191        logger->error(oss.str().c_str());        logger->error(oss.str().c_str());
192          jgood = false;
193      } catch (WrongCRCHeaderException exc) {      } catch (WrongCRCHeaderException exc) {
194        oss.str("");        oss.str("");
195        oss << exc.print();        oss << exc.print();
196        logger->error(oss.str().c_str());        logger->error(oss.str().c_str());
197          jgood = false;
198      } catch (WrongCRCException exc) {      } catch (WrongCRCException exc) {
199        oss.str("");        oss.str("");
200        oss << exc.print() << " " << Header->GetPscuHeader()->Print();        oss << exc.print() << " " << Header->GetPscuHeader()->Print();
201        logger->error(oss.str().c_str());        logger->error(oss.str().c_str());
202        archiveCorruptedPacket(Header->GetPscuHeader()->FileOffset, Header->GetPscuHeader()->PacketLenght);        archiveCorruptedPacket(Header->GetPscuHeader()->FileOffset, Header->GetPscuHeader()->PacketLenght);
203          jgood = false;      
204      } catch (UnidentifiedPacketException exc) {      } catch (UnidentifiedPacketException exc) {
205        oss.str("");        oss.str("");
206        oss << exc.print() << " " << Header->GetPscuHeader()->Print();        oss << exc.print() << " " << Header->GetPscuHeader()->Print();
207        logger->error(oss.str().c_str());        logger->error(oss.str().c_str());
208          jgood = false;
209      } catch (NotExistingCounterException exc) {      } catch (NotExistingCounterException exc) {
210        oss.str("");        oss.str("");
211        oss << exc.print() << " " << Header->GetPscuHeader()->Print();        oss << exc.print() << " " << Header->GetPscuHeader()->Print();
212        logger->error(oss.str().c_str());        logger->error(oss.str().c_str());
213          jgood = false;
214      } catch (LengthException exc) {      } catch (LengthException exc) {
215        oss.str("");        oss.str("");
216        oss << exc.print() << " " << Header->GetPscuHeader()->Print();        oss << exc.print() << " " << Header->GetPscuHeader()->Print();
217        logger->error(oss.str().c_str());        logger->error(oss.str().c_str());
218          jgood = false;
219      } catch (BackwardCounterException exc) {      } catch (BackwardCounterException exc) {
220        oss.str("");        oss.str("");
221        oss << exc.print() << " " << Header->GetPscuHeader()->Print();        oss << exc.print() << " " << Header->GetPscuHeader()->Print();
222        logger->error(oss.str().c_str());        logger->error(oss.str().c_str());
223          jgood = false;
224      } catch (...) {      } catch (...) {
225        logger->error("Couldn't read the event. Skipping to the next header. \n");        logger->error("Couldn't read the event. Skipping to the next header. \n");
226          jgood = false;
227      }      }
228      if ((step%1000) == 0) std::cout << step/1000 << "K \n";      if ((step%1000) == 0) std::cout << step/1000 << "K \n";
229      oss.str("");      oss.str("");
230      oss << "----endPck " << Header->GetPscuHeader()->GetCounter() << "\n";      oss << "----endPck " << Header->GetPscuHeader()->GetCounter() << "\n";
231      logger->info(oss.str().c_str());      logger->info(oss.str().c_str());
232    }    }
233      if ( !InputFile->eof() && ( InputFile->bad() || InputFile->fail() ) ) printf("\n\n ERROR READING RAW FILE! \n\n"); // E. Mocchiutti
234    
235      Header->GetCounter()->PrintCounters();      Header->GetCounter()->PrintCounters();
236      //if (corruptedPacketFile.is_open()) corruptedPacketFile.close();      //if (corruptedPacketFile.is_open()) corruptedPacketFile.close();
237  }  }
# Line 184  void EventReader::RunEvent(int EventNumb Line 239  void EventReader::RunEvent(int EventNumb
239  /**  /**
240   * Unpack the PSCU header from a file into the structure.   * Unpack the PSCU header from a file into the structure.
241   */   */
242  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");  
243    stringstream oss;    stringstream oss;
244    int response = 0;    int response = 0;
245      char buff[16];
246      memset(buff,  0, 16*sizeof(char));
247      InputFile->read(buff, sizeof(buff));
248      
249      
250      unsigned char PacketId1    = buff[3];
251      unsigned char PacketId2    = buff[4];
252      unsigned int  Counter      = (((UINT32)buff[5]<<16)&0x00FF0000) + (((UINT32)buff[6]<<8)&0x0000FF00) + (((UINT32)buff[7])&0x000000FF);
253      unsigned int  OrbitalTime  = (((UINT32)buff[8]<<24)&0xFF000000) + (((UINT32)buff[9]<<16)&0x00FF0000) +  (((UINT32)buff[10]<<8)&0x0000FF00) + (((UINT32)buff[11])&0x000000FF);
254      unsigned int  PacketLenght = (((UINT32)buff[12]<<16)&0x00FF0000) +  (((UINT32)buff[13]<<8)&0x0000FF00) + (((UINT32)buff[14])&0x000000FF);
255      unsigned char CRC          = buff[15];
256      unsigned char FileOffset   = 0;
257    
258    unsigned char PacketId1    = header[3];  
259    unsigned char PacketId2    = header[4];    if (Counter < prevPckCounter){
   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)){  
260      response = prevPckCounter - Counter;      response = prevPckCounter - Counter;
261      //oss.str("");      //oss.str("");
262      //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 264  void EventReader::UnpackPscuHeader(unsig
264      //logger->error(oss.str().c_str());      //logger->error(oss.str().c_str());
265    }    }
266    
267    if ((Counter > prevPckCounter + 1) && (initPos > 16)){    if (Counter > prevPckCounter + 1){
268      oss.str("");      oss.str("");
269      oss << "Packet counter is greater than before of " << (Counter - prevPckCounter);      oss << "Packet counter is greater than before of " << (Counter - prevPckCounter);
270      logger->error(oss.str().c_str());      logger->error(oss.str().c_str());
271    }    }
272        
273    if ((OrbitalTime == prevPckOBT) && (PacketId1 == 0x10) && (initPos > 16)) {    if ((OrbitalTime == prevPckOBT) & (PacketId1 == 0x10)){
274      oss.str("");      oss.str("");
275      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";
276      logger->error(oss.str().c_str());      logger->error(oss.str().c_str());
277      logger->error(Header->GetPscuHeader()->Print());      logger->error(Header->GetPscuHeader()->Print());
278    }    }
279    
280    if ((OrbitalTime < prevPckOBT) && (initPos > 16)) {    if (OrbitalTime < prevPckOBT){
281      oss.str("");      oss.str("");
282      oss << " Onboard Time is less than before of " << (prevPckOBT - OrbitalTime);      oss << " Onboard Time is less than before of " << (prevPckOBT - OrbitalTime);
283        notfirst = false;
284      logger->error(oss.str().c_str());      logger->error(oss.str().c_str());
285    }    }
286    
287    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)){
288      prevPckCounter = Counter;      prevPckCounter = Counter;
289      prevPckOBT     = OrbitalTime;      prevPckOBT     = OrbitalTime;
290        long int initPos = InputFile->tellg();
291      long int finalPos;      long int finalPos;
292      Header->GetPscuHeader()->SetPacketId(PacketId1, PacketId2);      Header->GetPscuHeader()->SetPacketId(PacketId1, PacketId2);
293      Header->GetPscuHeader()->SetCounter(Counter);      Header->GetPscuHeader()->SetCounter(Counter);
# Line 238  void EventReader::UnpackPscuHeader(unsig Line 296  void EventReader::UnpackPscuHeader(unsig
296      //plus the CRC legth (which varies for each type of packet)      //plus the CRC legth (which varies for each type of packet)
297      Header->GetPscuHeader()->SetPacketLenght(PacketLenght);      Header->GetPscuHeader()->SetPacketLenght(PacketLenght);
298      Header->GetPscuHeader()->SetCRC(CRC);      Header->GetPscuHeader()->SetCRC(CRC);
299      Header->GetPscuHeader()->SetFileOffset(((long int)(InputFile->tellg()) - 16));      Header->GetPscuHeader()->SetFileOffset(((unsigned long int)((unsigned long int)(InputFile->tellg()) - 16)));
300        //(unsigned long int)(InputFile->tellg() - 16));
301    } else {    } else {
302       //Here i should extract the block of Data for later analysis       /*Here i should extract the block of Data for later analysis */
303      InputFile->seekg(-(13), std::ios::cur);      InputFile->seekg(-(13), std::ios::cur);
304      oss.str("");      oss.str("");
305      oss << "CRC Header Error on packet:" << PscuHeader::Print((char*)header);      oss << "CRC Header Error on packet:" << PscuHeader::Print(buff);
306      throw WrongCRCHeaderException(oss.str().c_str());      throw WrongCRCHeaderException(oss.str().c_str());
307    }    }
308    
# Line 254  void EventReader::UnpackPscuHeader(unsig Line 313  void EventReader::UnpackPscuHeader(unsig
313    }    }
314  }  }
315    
   
316  /**  /**
317   * Unpack the trailer of a PSCU event into the structure.   * Unpack the trailer of a PSCU event into the structure.
318   */   */
# Line 262  void EventReader::UnpackPscuTrailer(void Line 320  void EventReader::UnpackPscuTrailer(void
320    
321  }  }
322    
 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 );  
 }  
   
323  /**  /**
324   * 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
325   */   */
326  bool EventReader::FindStart(unsigned char *header, long lenght) throw (std::exception) {  bool EventReader::FindStart(void) throw (std::exception) {
327  //search an hexadecimal sequence in a file  //search an hexadecimal sequence in a file
328  //subSign    ------> pointer to the sequence buffer  //subSign    ------> pointer to the sequence buffer
329  //subSignDim ------> dimension of the buffer  //subSignDim ------> dimension of the buffer
# Line 297  bool EventReader::FindStart(unsigned cha Line 339  bool EventReader::FindStart(unsigned cha
339    
340    int  buffSize = 64;    int  buffSize = 64;
341    int  index = 0;    int  index = 0;
342      int  loop = -1;
343    char buffer[buffSize];    char buffer[buffSize];
   char *offset;  
344    bool flagOverPad = false;    bool flagOverPad = false;
345      memset(buffer,  0, buffSize*sizeof(char));
346    while (!InputFile->eof()) {    while (!InputFile->eof()) {
347      InputFile->read(buffer, buffSize);      InputFile->read(buffer, sizeof(buffer));
348      index = 0;      index = 0;
349      offset = &buffer[0];      loop++;
350      while (index < buffSize - 3){      while (index < buffSize){
351          if (!(memcmp(offset, subSign, 3))){          dataByte = buffer[index++];
352                  InputFile->seekg(index - buffSize + 16, std::ios::cur);          if (dataByte == (char)(*(subSign+subIndex))){
353                  if (flagOverPad){              if (subIndex++ == (subSignDim-1)) {
354                          oss.str("");                  InputFile->seekg( (index - (subIndex + buffSize)), std::ios::cur);
355                          oss << "\n This packet beginning is farther than 64 byte from the end of the previous."                  if (flagOverPad){
356                          << "\n Below the is the last already unpacked packet";                      oss.str("");
357                          logger->error(oss.str().c_str());                      oss << "\n This packet beginning is farther than 64 byte from the end of the previous."
358                          logger->error(Header->GetPscuHeader()->Print());                          << "\n Below the is the last already unpacked packet";
359                  }                      logger->error(oss.str().c_str());
360                  memcpy(header, offset, lenght);                      logger->error(Header->GetPscuHeader()->Print());
361                  return true;                  }
362                    return true;
363                }
364            } else {
365                index = index - (subIndex);
366                subIndex = 0;
367          }          }
         index++;  
         offset++;  
368      }      }
369      //Needs to guarantee the overap of the buffer(s) in several loop      //Needs to guarantee the overap of the buffer(s) in several loop
370      flagOverPad = true;      flagOverPad = true;
371      InputFile->seekg( -3 , std::ios::cur);      InputFile->seekg( (-1)*(subSignDim + 1) , std::ios::cur);
372    }    }
373    return false;    return false;
374  }  }
375    
376    
377    int EventReader::archiveCorruptedPacket(long int offset, long int length) {
378            if (!corruptedPacketFile.is_open()) {
379                    oss.str("");
380                    oss << Run->GetUnpackPath().c_str() << "Corrupted.dat";
381                    cout << oss.str().c_str() << "\n";
382                    cout << dec << offset << "\n";
383                    cout << dec << length << "\n";
384                    corruptedPacketFile.open(oss.str().c_str(), ios::out);
385            }
386            char *buffer = new char[length];
387            InputFile->seekg(offset, ios_base::beg );
388            InputFile->read(buffer, length);
389            corruptedPacketFile.write(buffer, length);
390            InputFile->seekg(offset + 1, ios_base::beg );
391    }
392    
393  ClassImp(EventReader)  ClassImp(EventReader)
Legend:
Removed from v.6.7  
changed lines
  Added in v.6.15
  ViewVC Help
Powered by ViewVC 1.1.23