/[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.9 by mocchiut, Fri Sep 29 10:19:22 2006 UTC
# Line 1  Line 1 
1  /** @file  /** @file
2   * $Author: kusanagi $   * $Author: pam-rm2 $
3   * $Date: 2006/05/30 19:58:25 $   * $Date: 2006/08/23 14:39:44 $
4   * $Revision: 6.6 $   * $Revision: 6.8 $
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.8 2006/08/23 14:39:44 pam-rm2 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;
   unsigned char *header;  
123    while (!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 153  void EventReader::RunEvent(int EventNumb Line 152  void EventReader::RunEvent(int EventNumb
152        oss << exc.print() << " " << Header->GetPscuHeader()->Print();        oss << exc.print() << " " << Header->GetPscuHeader()->Print();
153        logger->error(oss.str().c_str());        logger->error(oss.str().c_str());
154        archiveCorruptedPacket(Header->GetPscuHeader()->FileOffset, Header->GetPscuHeader()->PacketLenght);        archiveCorruptedPacket(Header->GetPscuHeader()->FileOffset, Header->GetPscuHeader()->PacketLenght);
155          
156      } catch (UnidentifiedPacketException exc) {      } catch (UnidentifiedPacketException exc) {
157        oss.str("");        oss.str("");
158        oss << exc.print() << " " << Header->GetPscuHeader()->Print();        oss << exc.print() << " " << Header->GetPscuHeader()->Print();
# Line 184  void EventReader::RunEvent(int EventNumb Line 184  void EventReader::RunEvent(int EventNumb
184  /**  /**
185   * Unpack the PSCU header from a file into the structure.   * Unpack the PSCU header from a file into the structure.
186   */   */
187  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");  
188    stringstream oss;    stringstream oss;
189    int response = 0;    int response = 0;
190      char buff[16];
191      memset(buff,  0, 16*sizeof(char));
192      InputFile->read(buff, sizeof(buff));
193      
194      
195      unsigned char PacketId1    = buff[3];
196      unsigned char PacketId2    = buff[4];
197      unsigned int  Counter      = (((UINT32)buff[5]<<16)&0x00FF0000) + (((UINT32)buff[6]<<8)&0x0000FF00) + (((UINT32)buff[7])&0x000000FF);
198      unsigned int  OrbitalTime  = (((UINT32)buff[8]<<24)&0xFF000000) + (((UINT32)buff[9]<<16)&0x00FF0000) +  (((UINT32)buff[10]<<8)&0x0000FF00) + (((UINT32)buff[11])&0x000000FF);
199      unsigned int  PacketLenght = (((UINT32)buff[12]<<16)&0x00FF0000) +  (((UINT32)buff[13]<<8)&0x0000FF00) + (((UINT32)buff[14])&0x000000FF);
200      unsigned char CRC          = buff[15];
201      unsigned char FileOffset   = buff[15];
202    
203    
204    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)){  
205      response = prevPckCounter - Counter;      response = prevPckCounter - Counter;
206      //oss.str("");      //oss.str("");
207      //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 209  void EventReader::UnpackPscuHeader(unsig
209      //logger->error(oss.str().c_str());      //logger->error(oss.str().c_str());
210    }    }
211    
212    if ((Counter > prevPckCounter + 1) && (initPos > 16)){    if (Counter > prevPckCounter + 1){
213      oss.str("");      oss.str("");
214      oss << "Packet counter is greater than before of " << (Counter - prevPckCounter);      oss << "Packet counter is greater than before of " << (Counter - prevPckCounter);
215      logger->error(oss.str().c_str());      logger->error(oss.str().c_str());
216    }    }
217        
218    if ((OrbitalTime == prevPckOBT) && (PacketId1 == 0x10) && (initPos > 16)) {    if ((OrbitalTime == prevPckOBT) & (PacketId1 == 0x10)){
219      oss.str("");      oss.str("");
220      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";
221      logger->error(oss.str().c_str());      logger->error(oss.str().c_str());
222      logger->error(Header->GetPscuHeader()->Print());      logger->error(Header->GetPscuHeader()->Print());
223    }    }
224    
225    if ((OrbitalTime < prevPckOBT) && (initPos > 16)) {    if (OrbitalTime < prevPckOBT){
226      oss.str("");      oss.str("");
227      oss << " Onboard Time is less than before of " << (prevPckOBT - OrbitalTime);      oss << " Onboard Time is less than before of " << (prevPckOBT - OrbitalTime);
228      logger->error(oss.str().c_str());      logger->error(oss.str().c_str());
229    }    }
230    
231    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)){
232      prevPckCounter = Counter;      prevPckCounter = Counter;
233      prevPckOBT     = OrbitalTime;      prevPckOBT     = OrbitalTime;
234        long int initPos = InputFile->tellg();
235      long int finalPos;      long int finalPos;
236      Header->GetPscuHeader()->SetPacketId(PacketId1, PacketId2);      Header->GetPscuHeader()->SetPacketId(PacketId1, PacketId2);
237      Header->GetPscuHeader()->SetCounter(Counter);      Header->GetPscuHeader()->SetCounter(Counter);
# Line 240  void EventReader::UnpackPscuHeader(unsig Line 242  void EventReader::UnpackPscuHeader(unsig
242      Header->GetPscuHeader()->SetCRC(CRC);      Header->GetPscuHeader()->SetCRC(CRC);
243      Header->GetPscuHeader()->SetFileOffset(((long int)(InputFile->tellg()) - 16));      Header->GetPscuHeader()->SetFileOffset(((long int)(InputFile->tellg()) - 16));
244    } else {    } else {
245       //Here i should extract the block of Data for later analysis       /*Here i should extract the block of Data for later analysis */
246      InputFile->seekg(-(13), std::ios::cur);      InputFile->seekg(-(13), std::ios::cur);
247      oss.str("");      oss.str("");
248      oss << "CRC Header Error on packet:" << PscuHeader::Print((char*)header);      oss << "CRC Header Error on packet:" << PscuHeader::Print(buff);
249      throw WrongCRCHeaderException(oss.str().c_str());      throw WrongCRCHeaderException(oss.str().c_str());
250    }    }
251    
# Line 254  void EventReader::UnpackPscuHeader(unsig Line 256  void EventReader::UnpackPscuHeader(unsig
256    }    }
257  }  }
258    
   
259  /**  /**
260   * Unpack the trailer of a PSCU event into the structure.   * Unpack the trailer of a PSCU event into the structure.
261   */   */
# Line 262  void EventReader::UnpackPscuTrailer(void Line 263  void EventReader::UnpackPscuTrailer(void
263    
264  }  }
265    
 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 );  
 }  
   
266  /**  /**
267   * 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
268   */   */
269  bool EventReader::FindStart(unsigned char *header, long lenght) throw (std::exception) {  bool EventReader::FindStart(void) throw (std::exception) {
270  //search an hexadecimal sequence in a file  //search an hexadecimal sequence in a file
271  //subSign    ------> pointer to the sequence buffer  //subSign    ------> pointer to the sequence buffer
272  //subSignDim ------> dimension of the buffer  //subSignDim ------> dimension of the buffer
# Line 297  bool EventReader::FindStart(unsigned cha Line 282  bool EventReader::FindStart(unsigned cha
282    
283    int  buffSize = 64;    int  buffSize = 64;
284    int  index = 0;    int  index = 0;
285      int  loop = -1;
286    char buffer[buffSize];    char buffer[buffSize];
   char *offset;  
287    bool flagOverPad = false;    bool flagOverPad = false;
288      memset(buffer,  0, buffSize*sizeof(char));
289    while (!InputFile->eof()) {    while (!InputFile->eof()) {
290      InputFile->read(buffer, buffSize);      InputFile->read(buffer, sizeof(buffer));
291      index = 0;      index = 0;
292      offset = &buffer[0];      loop++;
293      while (index < buffSize - 3){      while (index < buffSize){
294          if (!(memcmp(offset, subSign, 3))){          dataByte = buffer[index++];
295                  InputFile->seekg(index - buffSize + 16, std::ios::cur);          if (dataByte == (char)(*(subSign+subIndex))){
296                  if (flagOverPad){              if (subIndex++ == (subSignDim-1)) {
297                          oss.str("");                  InputFile->seekg( (index - (subIndex + buffSize)), std::ios::cur);
298                          oss << "\n This packet beginning is farther than 64 byte from the end of the previous."                  if (flagOverPad){
299                          << "\n Below the is the last already unpacked packet";                      oss.str("");
300                          logger->error(oss.str().c_str());                      oss << "\n This packet beginning is farther than 64 byte from the end of the previous."
301                          logger->error(Header->GetPscuHeader()->Print());                          << "\n Below the is the last already unpacked packet";
302                  }                      logger->error(oss.str().c_str());
303                  memcpy(header, offset, lenght);                      logger->error(Header->GetPscuHeader()->Print());
304                  return true;                  }
305                    return true;
306                }
307            } else {
308                index = index - (subIndex);
309                subIndex = 0;
310          }          }
         index++;  
         offset++;  
311      }      }
312      //Needs to guarantee the overap of the buffer(s) in several loop      //Needs to guarantee the overap of the buffer(s) in several loop
313      flagOverPad = true;      flagOverPad = true;
314      InputFile->seekg( -3 , std::ios::cur);      InputFile->seekg( (-1)*(subSignDim + 1) , std::ios::cur);
315    }    }
316    return false;    return false;
317  }  }
318    
319    
320    int EventReader::archiveCorruptedPacket(long int offset, long int length) {
321            if (!corruptedPacketFile.is_open()) {
322                    oss.str("");
323                    oss << Run->GetUnpackPath().c_str() << "Corrupted.dat";
324                    cout << oss.str().c_str() << "\n";
325                    cout << dec << offset << "\n";
326                    cout << dec << length << "\n";
327                    corruptedPacketFile.open(oss.str().c_str(), ios::out);
328            }
329            char *buffer = new char[length];
330            InputFile->seekg(offset, ios_base::beg );
331            InputFile->read(buffer, length);
332            corruptedPacketFile.write(buffer, length);
333            InputFile->seekg(offset + 1, ios_base::beg );
334    }
335    
336  ClassImp(EventReader)  ClassImp(EventReader)
Legend:
Removed from v.6.7  
changed lines
  Added in v.6.9
  ViewVC Help
Powered by ViewVC 1.1.23