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

Diff of /yoda/techmodel/TmtcReader.cpp

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

revision 1.1 by kusanagi, Tue Jul 6 12:20:23 2004 UTC revision 6.2 by kusanagi, Tue May 30 19:10:02 2006 UTC
# Line 1  Line 1 
1  /** @file  /** @file
2   * $Source: /home/cvspamela/yoda/techmodel/TmtcReader.cpp,v $   * $Source: /home/cvsmanager/yoda/techmodel/TmtcReader.cpp,v $
3   * $Id: TmtcReader.cpp,v 1.8 2004/04/28 09:01:27 nagni Exp $   * $Id: TmtcReader.cpp,v 6.1 2006/03/21 21:49:07 kusanagi Exp $
4   * $Author: nagni $   * $Author: kusanagi $
5   *   *
6   * Implementation of the TmtcReader class.   * Implementation of the TmtcReader class.
7  * ToBeDone:  * ToBeDone:
8  * Control the CRC for the entire data Packet not just for single records  * Control the CRC for the entire data Packet not just for single records
9   */   */
10    
   
   
   
 #include <string>  
 #include <log4cpp/Category.hh>  
11  extern "C" {  extern "C" {
12  #include <sys/time.h>          #include "CRC.h"
 #include "CRC.h"  
13  }  }
   
 #include <fstream>  
 #include "stdio.h"  
14  #include "ReaderAlgorithms.h"  #include "ReaderAlgorithms.h"
   
 #include "event/tmtc/TmtcRecord.h"  
   
 using namespace pamela;  
15  using namespace pamela::techmodel;  using namespace pamela::techmodel;
16    
17  static log4cpp::Category& cat = log4cpp::Category::getInstance("pamela.techmodel.TmtcReader");    static log4cxx::LoggerPtr logger = log4cxx::Logger::getLogger(_T("pamela.techmodel.TmtcReader"));
18    
19  /**  /**
20   * Constructor.   * Constructor.
21   */   */
22  TmtcReader::TmtcReader(void):  TmtcReader::TmtcReader(void):
23    TechmodelAlgorithm(PacketType::Tmtc, "TechmodelTmtcReader") {    TechmodelAlgorithm(PacketType::Tmtc, "TechmodelTmtcReader") {
24    cat <<  log4cpp::Priority::DEBUG    logger->debug(_T("Constructor"));
       <<  "Constructor "  
       <<  "\n " << log4cpp::CategoryStream::ENDLINE;  
25    Tmtc = new TmtcEvent();    Tmtc = new TmtcEvent();
26  }  }
27    
# Line 45  TmtcReader::TmtcReader(void): Line 30  TmtcReader::TmtcReader(void):
30   */   */
31  std::string TmtcReader::GetVersionInfo(void) const {  std::string TmtcReader::GetVersionInfo(void) const {
32    return    return
33      "$Header: /home/cvspamela/yoda/techmodel/TmtcReader.cpp,v 1.8 2004/04/28 09:01:27 nagni Exp $\n";      "$Header: /home/cvsmanager/yoda/techmodel/TmtcReader.cpp,v 6.1 2006/03/21 21:49:07 kusanagi Exp $\n";
34  }  }
35    
36  /**  /**
# Line 60  void TmtcReader::Init(PamelaRun *run) { Line 45  void TmtcReader::Init(PamelaRun *run) {
45  /**  /**
46   * Unpack the Tmtc event from an input file.   * Unpack the Tmtc event from an input file.
47   */   */
48  void TmtcReader::RunEvent(int EventNumber, long int length) {  void TmtcReader::RunEvent(int EventNumber, long int length) throw (WrongCRCException){
49    
50  /*      int i, j, k;
51  //Just to test crc      /* The ' k ' indexs the number of recs.
52    char tempbuff[length];       * It is needed to be indipendent from ' i ' because in case of CRC error the single record is skipped and ' i ' increase by one, but correct records to be stored are still ' i '.
53    InputFile->read(tempbuff, sizeof(tempbuff));      */
54    UINT16 subCRC = 0;      k = 0;
55    for (int jj = 0; jj < length ; jj++){      char subData[TMTC_SUB_LENGTH];
     subCRC = CM_Compute_CRC16(subCRC, (BYTE*)(tempbuff+jj), 1);  
   }  
 //Just to test crc  
 */  
   
     int i, j;  
     char buff[TMTC_SUB_LENGTH];  
56      char CRCbuff[TMTC_SUBCRC_LENGTH];      char CRCbuff[TMTC_SUBCRC_LENGTH];
57      char eventCRC[TMTC_CRC_LENGTH];      char eventCRC[TMTC_CRC_LENGTH];
58      int numRecords = (length-TMTC_CRC_LENGTH)/(TMTC_SUB_LENGTH + TMTC_SUBCRC_LENGTH); //subtract the last two bytes because are the final CRC      int numRecords = (length-TMTC_CRC_LENGTH)/(TMTC_SUB_LENGTH + TMTC_SUBCRC_LENGTH); //subtract the last two bytes because are the final CRC
59      long int start;      long int start;
60        
61        TmtcRecord* rec;    
62      Tmtc->Records->Clear();      Tmtc->Records->Clear();
63      TClonesArray &recs = *(Tmtc->Records);      TClonesArray &recs = *(Tmtc->Records);
64      TmtcRecord* rec;          
65      UINT16    partialCRC = 0; //partial CRC updated as mcmd packet is read (to compare with the last two bytes of this event)      UINT16    partialCRC = 0; //partial CRC updated as mcmd packet is read (to compare with the last two bytes of this event)
66      UINT16    readCRC = 0;    //partial CRC updated as mcmd packet is read (to compare with the last two bytes of this event)      UINT16    readCRC = 0;    //partial CRC updated as mcmd packet is read (to compare with the last two bytes of this event)
67      int oldSize = recs.GetSize();      for(int i = 0; i < numRecords; i++) {
     recs.ExpandCreate(oldSize+numRecords-1);      
       
   
     for(i = 0; i < numRecords; i++) {  
68          start = InputFile->tellg();          start = InputFile->tellg();
69          InputFile->read(buff, sizeof(buff));          InputFile->read(subData, sizeof(subData));
70          InputFile->read(CRCbuff, sizeof(CRCbuff));          InputFile->read(CRCbuff, sizeof(CRCbuff));
   
         /*for (int jj = 0; jj < TMTC_SUB_LENGTH ; jj++){  
             partialCRC = CM_Compute_CRC8_8((char)partialCRC, (unsigned char*)buff[jj], 1);  
         }*/  
71                    
72          partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&buff, TMTC_SUB_LENGTH);          partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&subData, TMTC_SUB_LENGTH);
73          partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&CRCbuff, TMTC_SUBCRC_LENGTH);          partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&CRCbuff, TMTC_SUBCRC_LENGTH);
74    
75          //This == CRCBuff is not really parametric take care if have to change the static lengths          //This == CRCBuff is not really parametric take care if have to change the static lengths
76          if((UINT8)(CM_Compute_CRC16(0, (UINT8*)&buff, TMTC_SUB_LENGTH)) == (UINT8)CRCbuff[0]){          if((UINT8)(CM_Compute_CRC16(0, (UINT8*)&subData, TMTC_SUB_LENGTH)) == (UINT8)CRCbuff[0]){
77              rec = new TmtcRecord(); //add a new TmtcRecord              rec = new(recs[k++]) TmtcRecord(); //add a new TmtcRecord
78              rec->TM_RECORD_OBT = (((UINT32)buff[0]<<24)&0xFF000000) + (((UINT32)buff[1]<<16)&0x00FF0000) +  (((UINT32)buff[2]<<8)&0x0000FF00) + ((UINT32)buff[3])&0x000000FF;              rec->TM_RECORD_OBT            = (((UINT32)subData[0]<<24)&0xFF000000) + (((UINT32)subData[1]<<16)&0x00FF0000) +  (((UINT32)subData[2]<<8)&0x0000FF00) + (((UINT32)subData[3])&0x000000FF);
79                rec->TM_DIAG_AND_BILEVEL_ACQ  = (((UINT16)subData[4]<<8)&0x0000FF00) + (((UINT16)subData[5])&0x000000FF);
80              for(j = 0; j < 16; j++) {              
81                  rec->TM_DEA_ANA[j]   = (((UINT16)buff[4+j]<<8)&0xFF00) + (((UINT16)buff[5+j])&0x00FF);              for(int j = 0; j < 16; j++) {
82                  rec->TM_DEA_ANA_P[j] = (float)(rec->TM_DEA_ANA[j]*0.02);                  rec->TM_TH_ANA[j]    = ((((UINT16)subData[6 + 2*j]<<8)&0xFF00) + (((UINT16)subData[7 + 2*j])&0x00FF)); //20 is the size of TM_DEA_ANA(16) + OBT(4)
   
                 rec->TM_TH_ANA[j]    = buff[36+j]; //36 is the size of TM_DEA_ANA + OBT  
                 rec->TM_TH_ANA_P[j]  = convert_th(rec->TM_TH_ANA[j]);  
83              }              }
84                            
85              rec->TM_BIL_DIAG_ACQ =  buff[53];              for(int j = 0; j < 6; j++) {
86              rec->TM_CC_DIAG_ACQ  =  (((UINT32)buff[54]<<24)&0xFF000000) + (((UINT32)buff[55]<<16)&0x00FF0000) +  (((UINT32)buff[56]<<8)&0x0000FF00) + ((UINT32)buff[57])&0x000000FF;                  rec->TM_DEA_ANA[j]   = subData[38+j];
87              recs.AddAt(&(*rec), oldSize+i);              }
88    
89          } else {          } else {
90              cat <<  log4cpp::Priority::ERROR              stringstream oss;
91                  <<  "Wrong CRC on Subpacket int TMTC Packet starting at position " << start              oss.str("");
92                  <<  "\n " << log4cpp::CategoryStream::ENDLINE;              oss << "Wrong CRC on Subpacket int TMTC Packet starting at position"
93                    << start;
94                logger->warn(oss.str().c_str());
95          }          }
96      }          }    
97      InputFile->read(eventCRC, sizeof(eventCRC));      InputFile->read(eventCRC, sizeof(eventCRC));
98      readCRC = (((UINT16)(eventCRC[0]<<8))&0xFF00) + (((UINT16)eventCRC[1])&0x00FF);      readCRC = (((UINT16)(eventCRC[0]<<8))&0xFF00) + (((UINT16)eventCRC[1])&0x00FF);
99      if(!(partialCRC == readCRC)) {      if(partialCRC != readCRC) throw WrongCRCException(" Wrong Global CRC for TMTC Packet ");
         cat <<  log4cpp::Priority::ERROR  
             <<  "The test of calculated CRC with one wrote on file FAILED!!"  
             <<  "\n " << log4cpp::CategoryStream::ENDLINE;  
     }  
100  }  }
101    
102    /*
103  float TmtcReader::convert_th(int TH) {  float TmtcReader::convert_th(int TH) {
104    float a,q,deltax,deltay;    float a,q,deltax,deltay;
105    static int chiama_fun=0;    static int chiama_fun=0;
# Line 172  float TmtcReader::convert_th(int TH) { Line 140  float TmtcReader::convert_th(int TH) {
140      }      }
141    return (grado);    return (grado);
142  }  }
143    */
Legend:
Removed from v.1.1  
changed lines
  Added in v.6.2
  ViewVC Help
Powered by ViewVC 1.1.23