1 |
/** @file |
/** @file |
2 |
* $Source: /home/cvspamela/yoda/techmodel/McmdReader.cpp,v $ |
* $Source: /home/cvsmanager/yoda/techmodel/McmdReader.cpp,v $ |
3 |
* $Id: McmdReader.cpp,v 1.9 2004/04/28 09:01:27 nagni Exp $ |
* $Id: McmdReader.cpp,v 6.0 2006/02/07 17:11:09 kusanagi Exp $ |
4 |
* $Author: nagni $ |
* $Author: kusanagi $ |
5 |
* |
* |
6 |
* Implementation of the McmdReader class. |
* Implementation of the McmdReader class. |
7 |
*/ |
*/ |
8 |
|
|
|
#define BYTE unsigned char |
|
|
#include <string> |
|
|
#include <log4cpp/Category.hh> |
|
9 |
extern "C" { |
extern "C" { |
10 |
#include <sys/time.h> |
#include "CRC.h" |
|
#include "CRC.h" |
|
11 |
} |
} |
|
|
|
|
#include <fstream> |
|
|
#include "stdio.h" |
|
12 |
#include "ReaderAlgorithms.h" |
#include "ReaderAlgorithms.h" |
|
|
|
|
#include "event/mcmd/McmdRecord.h" |
|
|
|
|
|
using namespace pamela; |
|
13 |
using namespace pamela::techmodel; |
using namespace pamela::techmodel; |
14 |
|
|
15 |
static log4cpp::Category& cat = log4cpp::Category::getInstance("pamela.techmodel.McmdReader"); |
static log4cxx::LoggerPtr logger = log4cxx::Logger::getLogger(_T("pamela.techmodel.McmdReader")); |
16 |
|
static std::stringstream oss; |
17 |
/** |
/** |
18 |
* Constructor. |
* Constructor. |
19 |
*/ |
*/ |
20 |
McmdReader::McmdReader(void): |
McmdReader::McmdReader(void): |
21 |
TechmodelAlgorithm(PacketType::Mcmd, "Mcmd") { |
TechmodelAlgorithm(PacketType::Mcmd, "Mcmd") { |
22 |
cat << log4cpp::Priority::DEBUG |
logger->debug(_T("Constructor")); |
|
<< "Constructor " |
|
|
<< "\n " << log4cpp::CategoryStream::ENDLINE; |
|
23 |
Mcmd = new McmdEvent(); |
Mcmd = new McmdEvent(); |
24 |
} |
} |
25 |
|
|
28 |
*/ |
*/ |
29 |
std::string McmdReader::GetVersionInfo(void) const { |
std::string McmdReader::GetVersionInfo(void) const { |
30 |
return |
return |
31 |
"$Header: /home/cvspamela/yoda/techmodel/McmdReader.cpp,v 1.9 2004/04/28 09:01:27 nagni Exp $\n"; |
"$Header: /home/cvsmanager/yoda/techmodel/McmdReader.cpp,v 6.0 2006/02/07 17:11:09 kusanagi Exp $\n"; |
32 |
} |
} |
33 |
|
|
34 |
/** |
/** |
36 |
* event reader routines for all packet types. |
* event reader routines for all packet types. |
37 |
*/ |
*/ |
38 |
void McmdReader::Init(PamelaRun *run) { |
void McmdReader::Init(PamelaRun *run) { |
39 |
|
logger->debug(_T("Initialize")); |
40 |
SetInputStream(run); |
SetInputStream(run); |
41 |
run->WriteSubPacket(this, &Mcmd, Mcmd->Class()); |
run->WriteSubPacket(this, &Mcmd, Mcmd->Class()); |
42 |
} |
} |
64 |
* @Event Number |
* @Event Number |
65 |
* @length is the size in bytes of the event (or packet) |
* @length is the size in bytes of the event (or packet) |
66 |
*/ |
*/ |
67 |
void McmdReader::RunEvent(int EventNumber, long int length) { |
void McmdReader::RunEvent(int EventNumber, long int length) throw (WrongCRCException){ |
68 |
|
|
69 |
int i = 0; |
int i = 0; |
70 |
char OBT[4]; |
char OBT[4]; |
153 |
rec->McmdLength = (0x0fff)&(((UINT16)(subHeader[4]<<8)) + ((UINT16)subHeader[5])); |
rec->McmdLength = (0x0fff)&(((UINT16)(subHeader[4]<<8)) + ((UINT16)subHeader[5])); |
154 |
rec->TimeTag = (((UINT32)OBT[6]<<24)&0xFF000000) + (((UINT32)OBT[7]<<16)&0x00FF0000) + (((UINT32)OBT[8]<<8)&0x0000FF00) + (((UINT32)OBT[9])&0x000000FF); |
rec->TimeTag = (((UINT32)OBT[6]<<24)&0xFF000000) + (((UINT32)OBT[7]<<16)&0x00FF0000) + (((UINT32)OBT[8]<<8)&0x0000FF00) + (((UINT32)OBT[9])&0x000000FF); |
155 |
rec->endID = (BYTE)subTrailer[1]; |
rec->endID = (BYTE)subTrailer[1]; |
156 |
rec->setMcmdData((BYTE*)&subData); |
|
157 |
//partialCRC = CM_Compute_CRC16(partialCRC, (BYTE*)&readCRC, 1); |
rec->McmdData = new TArrayC(dataLength, subData); |
158 |
free(subData); |
delete [] subData; |
159 |
} else { |
} else { |
160 |
cat << log4cpp::Priority::ERROR |
oss.str(""); |
161 |
<< "Wrong CRC on Subpacket int MCMD Packet starting at position " << start |
oss << "Wrong CRC on Subpacket internal to TMTC Packet starting at position" |
162 |
<< "\n " << log4cpp::CategoryStream::ENDLINE; |
<< start; |
163 |
|
logger->warn(oss.str().c_str()); |
164 |
} |
} |
165 |
} |
} |
166 |
//in the end compare the calculated partial CRC with the MCMD packet CRC |
//in the end compare the calculated partial CRC with the MCMD packet CRC |
167 |
InputFile->read(eventCRC, sizeof(eventCRC)); |
InputFile->read(eventCRC, sizeof(eventCRC)); |
168 |
readCRC = (((UINT16)(eventCRC[0]<<8))&0xFF00) + (((UINT16)eventCRC[1])&0x00FF); |
readCRC = (((UINT16)(eventCRC[0]<<8))&0xFF00) + (((UINT16)eventCRC[1])&0x00FF); |
169 |
|
|
170 |
if(!(partialCRC == readCRC)) { |
if(partialCRC != readCRC) throw WrongCRCException(" Wrong Global CRC for MCMD Packet "); |
171 |
cat << log4cpp::Priority::ERROR |
/*if(!(partialCRC == readCRC)) { |
172 |
<< "The test of calculated CRC with one wrote on file FAILED!!" |
throw WrongCRCException(); |
173 |
<< "\n " << log4cpp::CategoryStream::ENDLINE; |
}*/ |
|
} |
|
174 |
} |
} |
175 |
|
|
176 |
|
|