| 1 |
/** @file |
| 2 |
* $Source: /home/cvsmanager/yoda/techmodel/TsbBReader.cpp,v $ |
| 3 |
* $Id: TsbBReader.cpp,v 2.1 2005/03/03 13:12:12 kusanagi Exp $ |
| 4 |
* $Author: kusanagi $ |
| 5 |
* |
| 6 |
* Implementation of the TsbBReader 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.TsbBReader")); |
| 23 |
|
| 24 |
/** |
| 25 |
* Constructor. |
| 26 |
*/ |
| 27 |
TsbBReader::TsbBReader(void): |
| 28 |
TechmodelAlgorithm(PacketType::TsbB, "TechmodelTsbB") { |
| 29 |
TsbB = new TsbBEvent(); |
| 30 |
} |
| 31 |
|
| 32 |
/** |
| 33 |
* Get a string with the version info of the algorithm. |
| 34 |
*/ |
| 35 |
std::string TsbBReader::GetVersionInfo(void) const { |
| 36 |
return "$Header: /home/cvsmanager/yoda/techmodel/TsbBReader.cpp,v 2.1 2005/03/03 13:12:12 kusanagi Exp $\n"; |
| 37 |
} |
| 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 TsbBReader::Init(PamelaRun *run) { |
| 44 |
SetInputStream(run); |
| 45 |
run->WriteSubPacket(this, &TsbB, TsbB->Class()); |
| 46 |
} |
| 47 |
|
| 48 |
/** |
| 49 |
* Unpack the TsbB event from an input file. |
| 50 |
*/ |
| 51 |
void TsbBReader::RunEvent(int EventNumber, long int length) throw (WrongCRCException){ |
| 52 |
|
| 53 |
char subData[length]; |
| 54 |
UINT16 subCRC; //CRC of the data |
| 55 |
UINT16 readCRC; //CRC read from the end of the subpacket |
| 56 |
long int dataLength = length - 2; |
| 57 |
int vars; |
| 58 |
|
| 59 |
InputFile->read(subData, sizeof(unsigned char)*length); |
| 60 |
subCRC = CM_Compute_CRC16(0, (BYTE*)subData, dataLength); |
| 61 |
readCRC = (((UINT16)(subData[length - 2]<<8))&0xFF00) + (((UINT16)subData[length - 1])&0x00FF); |
| 62 |
|
| 63 |
if (subCRC != readCRC) throw WrongCRCException(" Wrong CRC for TsbB Packet "); |
| 64 |
|
| 65 |
TsbBRecord* rec; |
| 66 |
|
| 67 |
TsbB->Records->Clear(); |
| 68 |
TClonesArray &recs = *(TsbB->Records); |
| 69 |
|
| 70 |
int i = 0; |
| 71 |
long int offset = 0; //dataLength/31; |
| 72 |
while (offset < dataLength){ |
| 73 |
rec = new(recs[i++]) TsbBRecord(); //add a new TsbB |
| 74 |
rec->RECORD_OBT = (((UINT32)subData[offset]<<24)&0xFF000000) + (((UINT32)subData[offset+1]<<16)&0x00FF0000) + (((UINT32)subData[offset+2]<<8)&0x0000FF00) + (((UINT32)subData[offset+3])&0x000000FF); |
| 75 |
rec->STATUS_CODE = subData[offset+4]; |
| 76 |
for (int j=0; j < 7; j++){ |
| 77 |
rec->B_FIELD[j] = ((((UINT16)subData[offset+5+j]<<8)&0xFF00) + (((UINT16)subData[offset+6+j])&0x00FF)); |
| 78 |
} |
| 79 |
offset = offset + 19; |
| 80 |
} |
| 81 |
//delete [] subData; |
| 82 |
} |
| 83 |
|