1 |
kusanagi |
1.1 |
/** @file |
2 |
kusanagi |
1.2 |
* $Source: /home/cvsmanager/yoda/techmodel/ArrDumpReader.cpp,v $ |
3 |
kusanagi |
1.3 |
* $Id: ArrDumpReader.cpp,v 1.2 2004/07/17 20:03:38 kusanagi Exp $ |
4 |
kusanagi |
1.2 |
* $Author: kusanagi $ |
5 |
kusanagi |
1.1 |
* |
6 |
|
|
* Implementation of the ArrDumpReader class. |
7 |
|
|
*/ |
8 |
|
|
|
9 |
|
|
#include <string> |
10 |
|
|
#include <log4cpp/Category.hh> |
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 log4cpp::Category& cat = log4cpp::Category::getInstance("pamela.techmodel.ArrDumpReader"); |
23 |
|
|
|
24 |
|
|
/** |
25 |
|
|
* Constructor. |
26 |
|
|
*/ |
27 |
|
|
ArrDumpReader::ArrDumpReader(void): |
28 |
|
|
TechmodelAlgorithm(PacketType::ArrDump, "TechmodelArrDump") { |
29 |
|
|
ArrDump = new ArrDumpEvent(); |
30 |
|
|
} |
31 |
|
|
|
32 |
|
|
/** |
33 |
|
|
* Get a string with the version info of the algorithm. |
34 |
|
|
*/ |
35 |
|
|
std::string ArrDumpReader::GetVersionInfo(void) const { |
36 |
kusanagi |
1.3 |
return "$Header: /home/cvsmanager/yoda/techmodel/ArrDumpReader.cpp,v 1.2 2004/07/17 20:03:38 kusanagi Exp $\n"; |
37 |
kusanagi |
1.1 |
} |
38 |
|
|
|
39 |
|
|
/** |
40 |
|
|
* Initialize the algorithm with a special run. This will initialize the |
41 |
|
|
* event reader routines for all packet types. |
42 |
|
|
*/ |
43 |
|
|
void ArrDumpReader::Init(PamelaRun *run) { |
44 |
|
|
SetInputStream(run); |
45 |
|
|
run->WriteSubPacket(this, &ArrDump, ArrDump->Class()); |
46 |
|
|
} |
47 |
|
|
|
48 |
|
|
/** |
49 |
|
|
* Unpack the ArrDump event from an input file. |
50 |
|
|
*/ |
51 |
|
|
void ArrDumpReader::RunEvent(int EventNumber, long int length) { |
52 |
|
|
|
53 |
|
|
char *subData; |
54 |
|
|
char eventCRC[2]; |
55 |
|
|
UINT16 subCRC; //CRC of the data |
56 |
|
|
UINT16 readCRC; //CRC read from the end of the subpacket |
57 |
|
|
long int dataLength; |
58 |
|
|
|
59 |
|
|
//the 2 bytes subtracted belong to the final event CRC bytes |
60 |
|
|
dataLength = length - (long int)2; |
61 |
|
|
|
62 |
|
|
subData = new char[dataLength]; |
63 |
|
|
InputFile->read(subData, sizeof(unsigned char)*dataLength); |
64 |
|
|
subCRC = CM_Compute_CRC16(0, (BYTE*)subData, dataLength); |
65 |
|
|
|
66 |
|
|
//took the final CRC to compare it with the previous calculated CRC of the data |
67 |
|
|
InputFile->read(eventCRC, sizeof(eventCRC)); |
68 |
|
|
readCRC = (((UINT16)(eventCRC[0]<<8))&0xFF00) + (((UINT16)eventCRC[1])&0x00FF); |
69 |
|
|
|
70 |
|
|
//finally check if the RecordCRC is correct and finally update the partialCRC |
71 |
|
|
if (subCRC == readCRC){ |
72 |
kusanagi |
1.2 |
ArrDumpRecord* rec; |
73 |
|
|
long int offset = 0; |
74 |
|
|
int i = 0; |
75 |
kusanagi |
1.3 |
int size; |
76 |
kusanagi |
1.2 |
ArrDump->Records->Clear(); |
77 |
|
|
TClonesArray &recs = *(ArrDump->Records); |
78 |
|
|
while (offset < dataLength){ |
79 |
|
|
rec = new(recs[i++]) ArrDumpRecord(); //add a new TmtcRecord |
80 |
|
|
rec->Arr_ID = ((UINT8)subData[offset])&0xFF; |
81 |
|
|
rec->Arr_len = (((UINT16)subData[offset+1]<<8)&0xFF00) + ((UINT16)subData[offset+2])&0x00FF; |
82 |
kusanagi |
1.3 |
rec->Data = new UINT32[rec->Arr_len]; |
83 |
|
|
size = sizeof(UINT32)*(rec->Arr_len); |
84 |
|
|
memcpy(rec->Data, (UINT32*)(subData+offset+3), size); |
85 |
|
|
offset = offset + size + 3; |
86 |
kusanagi |
1.2 |
} |
87 |
kusanagi |
1.1 |
free(subData); |
88 |
|
|
} else { |
89 |
|
|
cat << log4cpp::Priority::ERROR |
90 |
|
|
<< "Wrong CRC on Subpacket in ArrDump Packet " |
91 |
|
|
<< "\n " << log4cpp::CategoryStream::ENDLINE; |
92 |
|
|
} |
93 |
|
|
} |