/[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.6 by kusanagi, Wed Dec 22 11:38:35 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.5 2004/12/20 14:15:13 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.5 2004/12/20 14:15:13 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;
61      char buff[TMTC_SUB_LENGTH];      char subData[TMTC_SUB_LENGTH];
62      char CRCbuff[TMTC_SUBCRC_LENGTH];      char CRCbuff[TMTC_SUBCRC_LENGTH];
63      char eventCRC[TMTC_CRC_LENGTH];      char eventCRC[TMTC_CRC_LENGTH];
64      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
65      long int start;      long int start;
66        
67        TmtcRecord* rec;    
68      Tmtc->Records->Clear();      Tmtc->Records->Clear();
69      TClonesArray &recs = *(Tmtc->Records);      TClonesArray &recs = *(Tmtc->Records);
70      TmtcRecord* rec;          
71      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)
72      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);      
73            
74        for(int i = 0; i < numRecords; i++) {
     for(i = 0; i < numRecords; i++) {  
75          start = InputFile->tellg();          start = InputFile->tellg();
76          InputFile->read(buff, sizeof(buff));          InputFile->read(subData, sizeof(subData));
77          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);  
         }*/  
78                    
79          partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&buff, TMTC_SUB_LENGTH);          partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&subData, TMTC_SUB_LENGTH);
80          partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&CRCbuff, TMTC_SUBCRC_LENGTH);          partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&CRCbuff, TMTC_SUBCRC_LENGTH);
81    
82          //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
83          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]){
84              rec = new TmtcRecord(); //add a new TmtcRecord              rec = new(recs[i]) TmtcRecord(); //add a new TmtcRecord
85              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);
86                rec->TM_DIAG_AND_BILEVEL_ACQ  = (((UINT16)subData[4]<<8)&0x0000FF00) + (((UINT16)subData[5])&0x000000FF);
87              for(j = 0; j < 16; j++) {              for(int j = 0; j < 12; j++) {
88                  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]);  
89              }              }
90                            
91              rec->TM_BIL_DIAG_ACQ =  buff[53];              for(int j = 0; j < 6; j++) {
92              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[30+j];
93              recs.AddAt(&(*rec), oldSize+i);              }
94    
95          } else {          } else {
96              cat <<  log4cpp::Priority::ERROR              stringstream oss;
97                  <<  "Wrong CRC on Subpacket int TMTC Packet starting at position " << start              oss.str("");
98                  <<  "\n " << log4cpp::CategoryStream::ENDLINE;              oss << "Wrong CRC on Subpacket int TMTC Packet starting at position"
99                    << start;
100                logger->warn(oss.str().c_str());
101          }          }
102      }          }    
103      InputFile->read(eventCRC, sizeof(eventCRC));      InputFile->read(eventCRC, sizeof(eventCRC));
104      readCRC = (((UINT16)(eventCRC[0]<<8))&0xFF00) + (((UINT16)eventCRC[1])&0x00FF);      readCRC = (((UINT16)(eventCRC[0]<<8))&0xFF00) + (((UINT16)eventCRC[1])&0x00FF);
105      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;  
     }  
106  }  }
107    
108    /*
109  float TmtcReader::convert_th(int TH) {  float TmtcReader::convert_th(int TH) {
110    float a,q,deltax,deltay;    float a,q,deltax,deltay;
111    static int chiama_fun=0;    static int chiama_fun=0;
# Line 172  float TmtcReader::convert_th(int TH) { Line 146  float TmtcReader::convert_th(int TH) {
146      }      }
147    return (grado);    return (grado);
148  }  }
149    */
Legend:
Removed from v.1.1  
changed lines
  Added in v.2.6
  ViewVC Help
Powered by ViewVC 1.1.23