/[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.1.1 by kusanagi, Tue Jul 6 12:20:23 2004 UTC revision 6.1 by kusanagi, Tue Mar 21 21:49:07 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.0 2006/02/07 17:11:10 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 6.0 2006/02/07 17:11:10 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){
   
 /*  
 //Just to test crc  
   char tempbuff[length];  
   InputFile->read(tempbuff, sizeof(tempbuff));  
   UINT16 subCRC = 0;  
   for (int jj = 0; jj < length ; jj++){  
     subCRC = CM_Compute_CRC16(subCRC, (BYTE*)(tempbuff+jj), 1);  
   }  
 //Just to test crc  
 */  
59    
60      int i, j;      int i, j, k;
61      char buff[TMTC_SUB_LENGTH];      /* The ' k ' indexs the number of recs.
62         * 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 '.
63        */
64        k = 0;
65        char subData[TMTC_SUB_LENGTH];
66      char CRCbuff[TMTC_SUBCRC_LENGTH];      char CRCbuff[TMTC_SUBCRC_LENGTH];
67      char eventCRC[TMTC_CRC_LENGTH];      char eventCRC[TMTC_CRC_LENGTH];
68      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
69      long int start;      long int start;
70        
71        TmtcRecord* rec;    
72      Tmtc->Records->Clear();      Tmtc->Records->Clear();
73      TClonesArray &recs = *(Tmtc->Records);      TClonesArray &recs = *(Tmtc->Records);
74      TmtcRecord* rec;          
75      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)
76      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)
77      int oldSize = recs.GetSize();      for(int i = 0; i < numRecords; i++) {
     recs.ExpandCreate(oldSize+numRecords-1);      
       
   
     for(i = 0; i < numRecords; i++) {  
78          start = InputFile->tellg();          start = InputFile->tellg();
79          InputFile->read(buff, sizeof(buff));          InputFile->read(subData, sizeof(subData));
80          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);  
         }*/  
81                    
82          partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&buff, TMTC_SUB_LENGTH);          partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&subData, TMTC_SUB_LENGTH);
83          partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&CRCbuff, TMTC_SUBCRC_LENGTH);          partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&CRCbuff, TMTC_SUBCRC_LENGTH);
84    
85          //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
86          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]){
87              rec = new TmtcRecord(); //add a new TmtcRecord              rec = new(recs[k++]) TmtcRecord(); //add a new TmtcRecord
88              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);
89                rec->TM_DIAG_AND_BILEVEL_ACQ  = (((UINT16)subData[4]<<8)&0x0000FF00) + (((UINT16)subData[5])&0x000000FF);
90              for(j = 0; j < 16; j++) {              
91                  rec->TM_DEA_ANA[j]   = (((UINT16)buff[4+j]<<8)&0xFF00) + (((UINT16)buff[5+j])&0x00FF);              for(int j = 0; j < 16; j++) {
92                  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]);  
93              }              }
94                            
95              rec->TM_BIL_DIAG_ACQ =  buff[53];              for(int j = 0; j < 6; j++) {
96              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];
97              recs.AddAt(&(*rec), oldSize+i);              }
98    
99          } else {          } else {
100              cat <<  log4cpp::Priority::ERROR              stringstream oss;
101                  <<  "Wrong CRC on Subpacket int TMTC Packet starting at position " << start              oss.str("");
102                  <<  "\n " << log4cpp::CategoryStream::ENDLINE;              oss << "Wrong CRC on Subpacket int TMTC Packet starting at position"
103                    << start;
104                logger->warn(oss.str().c_str());
105          }          }
106      }          }    
107      InputFile->read(eventCRC, sizeof(eventCRC));      InputFile->read(eventCRC, sizeof(eventCRC));
108      readCRC = (((UINT16)(eventCRC[0]<<8))&0xFF00) + (((UINT16)eventCRC[1])&0x00FF);      readCRC = (((UINT16)(eventCRC[0]<<8))&0xFF00) + (((UINT16)eventCRC[1])&0x00FF);
109      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;  
     }  
110  }  }
111    
112    /*
113  float TmtcReader::convert_th(int TH) {  float TmtcReader::convert_th(int TH) {
114    float a,q,deltax,deltay;    float a,q,deltax,deltay;
115    static int chiama_fun=0;    static int chiama_fun=0;
# Line 172  float TmtcReader::convert_th(int TH) { Line 150  float TmtcReader::convert_th(int TH) {
150      }      }
151    return (grado);    return (grado);
152  }  }
153    */
Legend:
Removed from v.1.1.1.1  
changed lines
  Added in v.6.1
  ViewVC Help
Powered by ViewVC 1.1.23