1 |
/** @file |
/** @file |
2 |
* $Source: /home/cvspamela/yoda/techmodel/TmtcReader.cpp,v $ |
* $Source: /afs/ba.infn.it/user/pamela/src/CVS/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.3 2006/05/30 19:10:03 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 |
|
|
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: /afs/ba.infn.it/user/pamela/src/CVS/yoda/techmodel/TmtcReader.cpp,v 6.3 2006/05/30 19:10:03 kusanagi Exp $\n"; |
34 |
} |
} |
35 |
|
|
36 |
/** |
/** |
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)); |
memset(subData, 0, sizeof(subData)); |
70 |
|
InputFile->read(subData, sizeof(subData)); |
71 |
|
memset(CRCbuff, 0, sizeof(CRCbuff)); |
72 |
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); |
|
|
}*/ |
|
73 |
|
|
74 |
partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&buff, TMTC_SUB_LENGTH); |
partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&subData, TMTC_SUB_LENGTH); |
75 |
partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&CRCbuff, TMTC_SUBCRC_LENGTH); |
partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&CRCbuff, TMTC_SUBCRC_LENGTH); |
76 |
|
|
77 |
//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 |
78 |
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]){ |
79 |
rec = new TmtcRecord(); //add a new TmtcRecord |
rec = new(recs[k++]) TmtcRecord(); //add a new TmtcRecord |
80 |
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); |
81 |
|
rec->TM_DIAG_AND_BILEVEL_ACQ = (((UINT16)subData[4]<<8)&0x0000FF00) + (((UINT16)subData[5])&0x000000FF); |
82 |
for(j = 0; j < 16; j++) { |
|
83 |
rec->TM_DEA_ANA[j] = (((UINT16)buff[4+j]<<8)&0xFF00) + (((UINT16)buff[5+j])&0x00FF); |
for(int j = 0; j < 16; j++) { |
84 |
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]); |
|
85 |
} |
} |
86 |
|
|
87 |
rec->TM_BIL_DIAG_ACQ = buff[53]; |
for(int j = 0; j < 6; j++) { |
88 |
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]; |
89 |
recs.AddAt(&(*rec), oldSize+i); |
} |
90 |
|
|
91 |
} else { |
} else { |
92 |
cat << log4cpp::Priority::ERROR |
stringstream oss; |
93 |
<< "Wrong CRC on Subpacket int TMTC Packet starting at position " << start |
oss.str(""); |
94 |
<< "\n " << log4cpp::CategoryStream::ENDLINE; |
oss << "Wrong CRC on Subpacket int TMTC Packet starting at position" |
95 |
|
<< start; |
96 |
|
logger->warn(oss.str().c_str()); |
97 |
} |
} |
98 |
} |
} |
99 |
|
memset(eventCRC, 0, sizeof(eventCRC)); |
100 |
InputFile->read(eventCRC, sizeof(eventCRC)); |
InputFile->read(eventCRC, sizeof(eventCRC)); |
101 |
readCRC = (((UINT16)(eventCRC[0]<<8))&0xFF00) + (((UINT16)eventCRC[1])&0x00FF); |
readCRC = (((UINT16)(eventCRC[0]<<8))&0xFF00) + (((UINT16)eventCRC[1])&0x00FF); |
102 |
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; |
|
|
} |
|
103 |
} |
} |
104 |
|
|
105 |
|
/* |
106 |
float TmtcReader::convert_th(int TH) { |
float TmtcReader::convert_th(int TH) { |
107 |
float a,q,deltax,deltay; |
float a,q,deltax,deltay; |
108 |
static int chiama_fun=0; |
static int chiama_fun=0; |
143 |
} |
} |
144 |
return (grado); |
return (grado); |
145 |
} |
} |
146 |
|
*/ |