1 |
/** @file |
2 |
* $Source: /home/cvsmanager/yoda/techmodel/ArrDumpReader.cpp,v $ |
3 |
* $Id: ArrDumpReader.cpp,v 3.0 2005/03/04 15:54:11 kusanagi Exp $ |
4 |
* $Author: kusanagi $ |
5 |
* |
6 |
* Implementation of the ArrDumpReader class. |
7 |
*/ |
8 |
|
9 |
#include <string> |
10 |
#include <log4cxx/logger.h> |
11 |
#include <fstream> |
12 |
#include "stdio.h" |
13 |
extern "C" { |
14 |
#include "CRC.h" |
15 |
} |
16 |
|
17 |
#include "ReaderAlgorithms.h" |
18 |
|
19 |
using namespace pamela; |
20 |
using namespace pamela::techmodel; |
21 |
|
22 |
static log4cxx::LoggerPtr logger = log4cxx::Logger::getLogger(_T("pamela.techmodel.ArrDumpReader")); |
23 |
|
24 |
/** |
25 |
* Constructor. |
26 |
*/ |
27 |
ArrDumpReader::ArrDumpReader(void): |
28 |
TechmodelAlgorithm(PacketType::ArrDump, "TechmodelArrDump") { |
29 |
logger->debug(_T("Constructor")); |
30 |
ArrDump = new ArrDumpEvent(); |
31 |
} |
32 |
|
33 |
/** |
34 |
* Get a string with the version info of the algorithm. |
35 |
*/ |
36 |
std::string ArrDumpReader::GetVersionInfo(void) const { |
37 |
return "$Header: /home/cvsmanager/yoda/techmodel/ArrDumpReader.cpp,v 3.0 2005/03/04 15:54:11 kusanagi Exp $\n"; |
38 |
} |
39 |
|
40 |
/** |
41 |
* Initialize the algorithm with a special run. This will initialize the |
42 |
* event reader routines for all packet types. |
43 |
*/ |
44 |
void ArrDumpReader::Init(PamelaRun *run) { |
45 |
logger->debug(_T("Initialize")); |
46 |
SetInputStream(run); |
47 |
run->WriteSubPacket(this, &ArrDump, ArrDump->Class()); |
48 |
} |
49 |
|
50 |
/** |
51 |
* Unpack the ArrDump event from an input file. |
52 |
*/ |
53 |
void ArrDumpReader::RunEvent(int EventNumber, long int length) throw (WrongCRCException){ |
54 |
|
55 |
char subData[length]; |
56 |
UINT16 subCRC; //calculated CRC of the data |
57 |
UINT16 readCRC; //CRC read from the end of the subpacket |
58 |
long int dataLength = length - 2; //the block of data |
59 |
|
60 |
InputFile->read(subData, sizeof(subData)); |
61 |
subCRC = CM_Compute_CRC16(0, (UINT8*)subData, dataLength); |
62 |
readCRC = (((UINT16)(subData[length - 2]<<8))&0xFF00) + (((UINT16)subData[length - 1])&0x00FF); |
63 |
|
64 |
//if (subCRC != readCRC) throw WrongCRCException(" Wrong CRC for ArrDump Packet "); |
65 |
if (subCRC != readCRC) { |
66 |
logger->error("WRONG CRC FOR ArrDump PACKET. processed anyway for CPU debugging"); |
67 |
} |
68 |
|
69 |
ArrDumpRecord* rec; |
70 |
ArrDump->PARAMETER_STAMP = (((UINT32)subData[0]<<24)&0xFF000000) + (((UINT32)subData[1]<<16)&0x00FF0000) + (((UINT32)subData[2]<<8)&0x0000FF00) + (((UINT32)subData[3])&0x000000FF); |
71 |
long int offset = 4; |
72 |
int i = 0; |
73 |
ArrDump->Records->Clear(); |
74 |
TClonesArray &recs = *(ArrDump->Records); |
75 |
while (offset < dataLength){ |
76 |
rec = new(recs[i++]) ArrDumpRecord(); //add a new TmtcRecord |
77 |
rec->Arr_ID = ((UINT8)subData[offset])&0xFF; |
78 |
rec->Arr_len = (((UINT16)subData[offset+1]<<8)&0xFF00) + ((UINT16)subData[offset+2])&0x00FF; |
79 |
rec->Data = new TArrayI((int)rec->Arr_len, (int*)(subData+offset+3)); |
80 |
offset = offset + sizeof(UINT32)*(rec->Arr_len) + 3; |
81 |
} |
82 |
} |