1 |
/** @file |
/** @file |
2 |
* $Source: /home/cvsmanager/yoda/techmodel/TmtcReader.cpp,v $ |
* $Source: /home/cvsmanager/yoda/techmodel/TmtcReader.cpp,v $ |
3 |
* $Id: TmtcReader.cpp,v 1.2 2004/07/17 20:03:38 kusanagi Exp $ |
* $Id: TmtcReader.cpp,v 2.3 2004/12/17 12:46:20 kusanagi Exp $ |
4 |
* $Author: kusanagi $ |
* $Author: kusanagi $ |
5 |
* |
* |
6 |
* Implementation of the TmtcReader class. |
* Implementation of the TmtcReader class. |
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" |
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 |
|
|
40 |
*/ |
*/ |
41 |
std::string TmtcReader::GetVersionInfo(void) const { |
std::string TmtcReader::GetVersionInfo(void) const { |
42 |
return |
return |
43 |
"$Header: /home/cvsmanager/yoda/techmodel/TmtcReader.cpp,v 1.2 2004/07/17 20:03:38 kusanagi Exp $\n"; |
"$Header: /home/cvsmanager/yoda/techmodel/TmtcReader.cpp,v 2.3 2004/12/17 12:46:20 kusanagi Exp $\n"; |
44 |
} |
} |
45 |
|
|
46 |
/** |
/** |
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 |
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*)&subData, TMTC_SUB_LENGTH)) == (UINT8)CRCbuff[0]){ |
if((UINT8)(CM_Compute_CRC16(0, (UINT8*)&subData, TMTC_SUB_LENGTH)) == (UINT8)CRCbuff[0]){ |
105 |
rec = new(recs[i]) TmtcRecord(); //add a new TmtcRecord |
rec = new(recs[i]) TmtcRecord(); //add a new TmtcRecord |
106 |
rec->TM_RECORD_OBT = (((UINT32)subData[0]<<24)&0xFF000000) + (((UINT32)subData[1]<<16)&0x00FF0000) + (((UINT32)subData[2]<<8)&0x0000FF00) + ((UINT32)subData[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)subData[4+j]<<8)&0xFF00) + (((UINT16)subData[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] = subData[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 = subData[53]; |
for(j = 0; j < 6; j++) { |
113 |
rec->TM_CC_DIAG_ACQ = (((UINT32)subData[54]<<24)&0xFF000000) + (((UINT32)subData[55]<<16)&0x00FF0000) + (((UINT32)subData[56]<<8)&0x0000FF00) + ((UINT32)subData[57])&0x000000FF; |
rec->TM_DEA_ANA[j] = subData[30+j]; |
114 |
|
} |
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; |
167 |
} |
} |
168 |
return (grado); |
return (grado); |
169 |
} |
} |
170 |
|
*/ |