/[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.6 by kusanagi, Tue May 30 19:58:25 2006 UTC revision 6.7 by kusanagi, Wed Aug 16 13:15:23 2006 UTC
# Line 1  Line 1 
1  /** @file  /** @file
2   * $Author: kusanagi $   * $Author: kusanagi $
3   * $Date: 2006/05/30 19:10:03 $   * $Date: 2006/05/30 19:58:25 $
4   * $Revision: 6.5 $   * $Revision: 6.6 $
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::Calib2_Ac2,      new CalibCalReader));    TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibCal,        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.5 2006/05/30 19:10:03 kusanagi Exp $\n";      "$Header: /home/cvsmanager/yoda/techmodel/EventReader.cpp,v 6.6 2006/05/30 19:58:25 kusanagi 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;
124    while (!InputFile->eof() && ((step++ < maxPackets) || (maxPackets == 0))){    while (!InputFile->eof() && ((step++ < maxPackets) || (maxPackets == 0))){
125      try {      try {
126        if (FindStart()) {        if (FindStart(*&header, 16)) {
127              UnpackPscuHeader();              UnpackPscuHeader(*&header);
128              type = Header->GetPscuHeader()->GetPacketType();              type = Header->GetPscuHeader()->GetPacketType();
129              AlgorithmMap::iterator i = TechmodelAlgorithmMap.find(type);              AlgorithmMap::iterator i = TechmodelAlgorithmMap.find(type);
130              if (i != TechmodelAlgorithmMap.end()) {              if (i != TechmodelAlgorithmMap.end()) {
# Line 152  void EventReader::RunEvent(int EventNumb Line 153  void EventReader::RunEvent(int EventNumb
153        oss << exc.print() << " " << Header->GetPscuHeader()->Print();        oss << exc.print() << " " << Header->GetPscuHeader()->Print();
154        logger->error(oss.str().c_str());        logger->error(oss.str().c_str());
155        archiveCorruptedPacket(Header->GetPscuHeader()->FileOffset, Header->GetPscuHeader()->PacketLenght);        archiveCorruptedPacket(Header->GetPscuHeader()->FileOffset, Header->GetPscuHeader()->PacketLenght);
         
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(void) throw (WrongCRCHeaderException, LengthException, BackwardCounterException) {  void EventReader::UnpackPscuHeader(unsigned char *header) throw (WrongCRCHeaderException, LengthException, BackwardCounterException) {
188      if (header == NULL) throw LengthException("errore di lunghezza");
189    stringstream oss;    stringstream oss;
190    int response = 0;    int response = 0;
   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];  
   
191    
192    if (Counter < prevPckCounter){    unsigned char PacketId1    = header[3];
193      unsigned char PacketId2    = header[4];
194      unsigned int  Counter      = (((UINT32)header[5]<<16)&0x00FF0000) + (((UINT32)header[6]<<8)&0x0000FF00) + (((UINT32)header[7])&0x000000FF);
195      unsigned int  OrbitalTime  = (((UINT32)header[8]<<24)&0xFF000000) + (((UINT32)header[9]<<16)&0x00FF0000) +  (((UINT32)header[10]<<8)&0x0000FF00) + (((UINT32)header[11])&0x000000FF);
196      unsigned int  PacketLenght = (((UINT32)header[12]<<16)&0x00FF0000) +  (((UINT32)header[13]<<8)&0x0000FF00) + (((UINT32)header[14])&0x000000FF);
197      unsigned char CRC          = header[15];
198      unsigned char FileOffset   = header[15];
199    
200      long int initPos = InputFile->tellg();
201      // Check parameters anomalies. If initPos < 16 it is the first packet
202      // (supposing a correct starting packet!)
203      if ((Counter < prevPckCounter) && (initPos > 16)){
204      response = prevPckCounter - Counter;      response = prevPckCounter - Counter;
205      //oss.str("");      //oss.str("");
206      //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(void) Line 208  void EventReader::UnpackPscuHeader(void)
208      //logger->error(oss.str().c_str());      //logger->error(oss.str().c_str());
209    }    }
210    
211    if (Counter > prevPckCounter + 1){    if ((Counter > prevPckCounter + 1) && (initPos > 16)){
212      oss.str("");      oss.str("");
213      oss << "Packet counter is greater than before of " << (Counter - prevPckCounter);      oss << "Packet counter is greater than before of " << (Counter - prevPckCounter);
214      logger->error(oss.str().c_str());      logger->error(oss.str().c_str());
215    }    }
216        
217    if ((OrbitalTime == prevPckOBT) & (PacketId1 == 0x10)){    if ((OrbitalTime == prevPckOBT) && (PacketId1 == 0x10) && (initPos > 16)) {
218      oss.str("");      oss.str("");
219      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";
220      logger->error(oss.str().c_str());      logger->error(oss.str().c_str());
221      logger->error(Header->GetPscuHeader()->Print());      logger->error(Header->GetPscuHeader()->Print());
222    }    }
223    
224    if (OrbitalTime < prevPckOBT){    if ((OrbitalTime < prevPckOBT) && (initPos > 16)) {
225      oss.str("");      oss.str("");
226      oss << " Onboard Time is less than before of " << (prevPckOBT - OrbitalTime);      oss << " Onboard Time is less than before of " << (prevPckOBT - OrbitalTime);
227      logger->error(oss.str().c_str());      logger->error(oss.str().c_str());
228    }    }
229    
230    if (((BYTE)CM_Compute_CRC16(0, (BYTE*)&buff, 15) == (BYTE)buff[15]) && (PacketId1 == PacketId2)){    if ( ((BYTE)CM_Compute_CRC16(0, (BYTE*)header, 15) == (BYTE)header[15]) && (PacketId1 == PacketId2)){
231      prevPckCounter = Counter;      prevPckCounter = Counter;
232      prevPckOBT     = OrbitalTime;      prevPckOBT     = OrbitalTime;
     long int initPos = InputFile->tellg();  
233      long int finalPos;      long int finalPos;
234      Header->GetPscuHeader()->SetPacketId(PacketId1, PacketId2);      Header->GetPscuHeader()->SetPacketId(PacketId1, PacketId2);
235      Header->GetPscuHeader()->SetCounter(Counter);      Header->GetPscuHeader()->SetCounter(Counter);
# Line 241  void EventReader::UnpackPscuHeader(void) Line 240  void EventReader::UnpackPscuHeader(void)
240      Header->GetPscuHeader()->SetCRC(CRC);      Header->GetPscuHeader()->SetCRC(CRC);
241      Header->GetPscuHeader()->SetFileOffset(((long int)(InputFile->tellg()) - 16));      Header->GetPscuHeader()->SetFileOffset(((long int)(InputFile->tellg()) - 16));
242    } else {    } else {
243       /*Here i should extract the block of Data for later analysis */       //Here i should extract the block of Data for later analysis
244      InputFile->seekg(-(13), std::ios::cur);      InputFile->seekg(-(13), std::ios::cur);
245      oss.str("");      oss.str("");
246      oss << "CRC Header Error on packet:" << PscuHeader::Print(buff);      oss << "CRC Header Error on packet:" << PscuHeader::Print((char*)header);
247      throw WrongCRCHeaderException(oss.str().c_str());      throw WrongCRCHeaderException(oss.str().c_str());
248    }    }
249    
# Line 255  void EventReader::UnpackPscuHeader(void) Line 254  void EventReader::UnpackPscuHeader(void)
254    }    }
255  }  }
256    
257    
258  /**  /**
259   * Unpack the trailer of a PSCU event into the structure.   * Unpack the trailer of a PSCU event into the structure.
260   */   */
# Line 262  void EventReader::UnpackPscuTrailer(void Line 262  void EventReader::UnpackPscuTrailer(void
262    
263  }  }
264    
265    int EventReader::archiveCorruptedPacket(long int offset, long int length) {
266            if (!corruptedPacketFile.is_open()) {
267                    oss.str("");
268                    oss << Run->GetUnpackPath().c_str() << "Corrupted.dat";
269                    cout << oss.str().c_str() << "\n";
270                    cout << dec << offset << "\n";
271                    cout << dec << length << "\n";
272                    corruptedPacketFile.open(oss.str().c_str(), ios::out);
273            }
274            char *buffer = new char[length];
275            InputFile->seekg(offset, ios_base::beg );
276            InputFile->read(buffer, length);
277            corruptedPacketFile.write(buffer, length);
278            InputFile->seekg(offset + 1, ios_base::beg );
279    }
280    
281  /**  /**
282   * 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
283   */   */
284  bool EventReader::FindStart(void) throw (std::exception) {  bool EventReader::FindStart(unsigned char *header, long lenght) throw (std::exception) {
285  //search an hexadecimal sequence in a file  //search an hexadecimal sequence in a file
286  //subSign    ------> pointer to the sequence buffer  //subSign    ------> pointer to the sequence buffer
287  //subSignDim ------> dimension of the buffer  //subSignDim ------> dimension of the buffer
# Line 281  bool EventReader::FindStart(void) throw Line 297  bool EventReader::FindStart(void) throw
297    
298    int  buffSize = 64;    int  buffSize = 64;
299    int  index = 0;    int  index = 0;
   int  loop = -1;  
300    char buffer[buffSize];    char buffer[buffSize];
301      char *offset;
302    bool flagOverPad = false;    bool flagOverPad = false;
303    
304    while (!InputFile->eof()) {    while (!InputFile->eof()) {
305      InputFile->read(buffer, sizeof(buffer));      InputFile->read(buffer, buffSize);
306      index = 0;      index = 0;
307      loop++;      offset = &buffer[0];
308      while (index < buffSize){      while (index < buffSize - 3){
309          dataByte = buffer[index++];          if (!(memcmp(offset, subSign, 3))){
310          if (dataByte == (char)(*(subSign+subIndex))){                  InputFile->seekg(index - buffSize + 16, std::ios::cur);
311              if (subIndex++ == (subSignDim-1)) {                  if (flagOverPad){
312                  InputFile->seekg( (index - (subIndex + buffSize)), std::ios::cur);                          oss.str("");
313                  if (flagOverPad){                          oss << "\n This packet beginning is farther than 64 byte from the end of the previous."
314                      oss.str("");                          << "\n Below the is the last already unpacked packet";
315                      oss << "\n This packet beginning is farther than 64 byte from the end of the previous."                          logger->error(oss.str().c_str());
316                          << "\n Below the is the last already unpacked packet";                          logger->error(Header->GetPscuHeader()->Print());
317                      logger->error(oss.str().c_str());                  }
318                      logger->error(Header->GetPscuHeader()->Print());                  memcpy(header, offset, lenght);
319                  }                  return true;
                 return true;  
             }  
         } else {  
             index = index - (subIndex);  
             subIndex = 0;  
320          }          }
321            index++;
322            offset++;
323      }      }
324      //Needs to guarantee the overap of the buffer(s) in several loop      //Needs to guarantee the overap of the buffer(s) in several loop
325      flagOverPad = true;      flagOverPad = true;
326      InputFile->seekg( (-1)*(subSignDim + 1) , std::ios::cur);      InputFile->seekg( -3 , std::ios::cur);
327    }    }
328    return false;    return false;
329  }  }
330    
   
 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 );  
 }  
   
331  ClassImp(EventReader)  ClassImp(EventReader)
Legend:
Removed from v.6.6  
changed lines
  Added in v.6.7
  ViewVC Help
Powered by ViewVC 1.1.23