/[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 2.3 by kusanagi, Fri Dec 17 12:46:20 2004 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 2.2 2004/12/09 08:48:41 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    
   
   
   
11  #include <string>  #include <string>
12  #include <log4cpp/Category.hh>  #include <log4cxx/logger.h>
13  extern "C" {  extern "C" {
14  #include <sys/time.h>  #include <sys/time.h>
15  #include "CRC.h"  #include "CRC.h"
# Line 27  extern "C" { Line 24  extern "C" {
24  using namespace pamela;  using namespace pamela;
25  using namespace pamela::techmodel;  using namespace pamela::techmodel;
26    
27  static log4cpp::Category& cat = log4cpp::Category::getInstance("pamela.techmodel.TmtcReader");    static log4cxx::LoggerPtr logger = log4cxx::Logger::getLogger(_T("pamela.techmodel.TmtcReader"));
28    
29  /**  /**
30   * Constructor.   * Constructor.
31   */   */
32  TmtcReader::TmtcReader(void):  TmtcReader::TmtcReader(void):
33    TechmodelAlgorithm(PacketType::Tmtc, "TechmodelTmtcReader") {    TechmodelAlgorithm(PacketType::Tmtc, "TechmodelTmtcReader") {
34    cat <<  log4cpp::Priority::DEBUG    logger->debug(_T("Constructor"));
       <<  "Constructor "  
       <<  "\n " << log4cpp::CategoryStream::ENDLINE;  
35    Tmtc = new TmtcEvent();    Tmtc = new TmtcEvent();
36  }  }
37    
# Line 45  TmtcReader::TmtcReader(void): Line 40  TmtcReader::TmtcReader(void):
40   */   */
41  std::string TmtcReader::GetVersionInfo(void) const {  std::string TmtcReader::GetVersionInfo(void) const {
42    return    return
43      "$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 2.2 2004/12/09 08:48:41 kusanagi Exp $\n";
44  }  }
45    
46  /**  /**
# Line 60  void TmtcReader::Init(PamelaRun *run) { Line 55  void TmtcReader::Init(PamelaRun *run) {
55  /**  /**
56   * Unpack the Tmtc event from an input file.   * Unpack the Tmtc event from an input file.
57   */   */
58  void TmtcReader::RunEvent(int EventNumber, long int length) {  void TmtcReader::RunEvent(int EventNumber, long int length) throw (WrongCRCException){
59    
60  /*  /*
61  //Just to test crc  //Just to test crc
# Line 74  void TmtcReader::RunEvent(int EventNumbe Line 69  void TmtcReader::RunEvent(int EventNumbe
69  */  */
70    
71      int i, j;      int i, j;
72      char buff[TMTC_SUB_LENGTH];      char subData[TMTC_SUB_LENGTH];
73      char CRCbuff[TMTC_SUBCRC_LENGTH];      char CRCbuff[TMTC_SUBCRC_LENGTH];
74      char eventCRC[TMTC_CRC_LENGTH];      char eventCRC[TMTC_CRC_LENGTH];
75      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
76      long int start;      long int start;
77        
78        TmtcRecord* rec;    
79      Tmtc->Records->Clear();      Tmtc->Records->Clear();
80      TClonesArray &recs = *(Tmtc->Records);      TClonesArray &recs = *(Tmtc->Records);
81      TmtcRecord* rec;          
82      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)
83      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)
     int oldSize = recs.GetSize();  
     recs.ExpandCreate(oldSize+numRecords-1);      
84            
85    /*    char tempData[length-TMTC_CRC_LENGTH];
86        InputFile->read(tempData, sizeof(tempData));
87        partialCRC = CM_Compute_CRC16(0, (UINT8*)tempData, (length-TMTC_CRC_LENGTH));
88    */
89    
90      for(i = 0; i < numRecords; i++) {      for(i = 0; i < numRecords; i++) {
91          start = InputFile->tellg();          start = InputFile->tellg();
92          InputFile->read(buff, sizeof(buff));          InputFile->read(subData, sizeof(subData));
93          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);  
         }*/  
94                    
95          partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&buff, TMTC_SUB_LENGTH);      /*    for (int jj = 0; jj < TMTC_SUB_LENGTH ; jj++){
96                partialCRC = CM_Compute_CRC16(0, (UINT8*)tempData, (length-TMTC_CRC_LENGTH));
97            }
98        */
99      
100            partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&subData, TMTC_SUB_LENGTH);
101          partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&CRCbuff, TMTC_SUBCRC_LENGTH);          partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&CRCbuff, TMTC_SUBCRC_LENGTH);
102    
103          //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
104          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]){
105              rec = new TmtcRecord(); //add a new TmtcRecord              rec = new(recs[i]) TmtcRecord(); //add a new TmtcRecord
106              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;
107                rec->TM_DIAG_AND_BILEVEL_ACQ  = (((UINT16)subData[4]<<8)&0x0000FF00) + ((UINT16)subData[5])&0x000000FF;
108              for(j = 0; j < 16; j++) {              for(j = 0; j < 12; j++) {
109                  rec->TM_DEA_ANA[j]   = (((UINT16)buff[4+j]<<8)&0xFF00) + (((UINT16)buff[5+j])&0x00FF);                  rec->TM_TH_ANA[j]    = ((((UINT16)subData[6+j]<<8)&0xFF00) + (((UINT16)subData[7+j])&0x00FF)); //20 is the size of TM_DEA_ANA(16) + OBT(4)
                 rec->TM_DEA_ANA_P[j] = (float)(rec->TM_DEA_ANA[j]*0.02);  
   
                 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]);  
110              }              }
111                            
112              rec->TM_BIL_DIAG_ACQ =  buff[53];              for(j = 0; j < 6; j++) {
113              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[8+j];
114              recs.AddAt(&(*rec), oldSize+i);              }
115    
116          } else {          } else {
117              cat <<  log4cpp::Priority::ERROR              stringstream oss;
118                  <<  "Wrong CRC on Subpacket int TMTC Packet starting at position " << start              oss.str("");
119                  <<  "\n " << log4cpp::CategoryStream::ENDLINE;              oss << "Wrong CRC on Subpacket int TMTC Packet starting at position"
120                    << start;
121                logger->warn(oss.str().c_str());
122          }          }
123      }          }    
124      InputFile->read(eventCRC, sizeof(eventCRC));      InputFile->read(eventCRC, sizeof(eventCRC));
125      readCRC = (((UINT16)(eventCRC[0]<<8))&0xFF00) + (((UINT16)eventCRC[1])&0x00FF);      readCRC = (((UINT16)(eventCRC[0]<<8))&0xFF00) + (((UINT16)eventCRC[1])&0x00FF);
126      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;  
     }  
127  }  }
128    
129    /*
130  float TmtcReader::convert_th(int TH) {  float TmtcReader::convert_th(int TH) {
131    float a,q,deltax,deltay;    float a,q,deltax,deltay;
132    static int chiama_fun=0;    static int chiama_fun=0;
# Line 172  float TmtcReader::convert_th(int TH) { Line 167  float TmtcReader::convert_th(int TH) {
167      }      }
168    return (grado);    return (grado);
169  }  }
170    */
Legend:
Removed from v.1.1  
changed lines
  Added in v.2.3
  ViewVC Help
Powered by ViewVC 1.1.23