1 |
/** @file |
/** @file |
2 |
* $Source: /home/cvsmanager/yoda/techmodel/TsbTReader.cpp,v $ |
* $Source: /home/cvsmanager/yoda/techmodel/TsbTReader.cpp,v $ |
3 |
* $Id: TsbTReader.cpp,v 2.1 2005/03/03 13:12:18 kusanagi Exp $ |
* $Id: TsbTReader.cpp,v 6.0 2006/02/07 17:11:10 kusanagi Exp $ |
4 |
* $Author: kusanagi $ |
* $Author: kusanagi $ |
5 |
* |
* |
6 |
* Implementation of the TsbTReader class. |
* Implementation of the TsbTReader class. |
7 |
*/ |
*/ |
8 |
|
|
|
#include <string> |
|
|
#include <log4cxx/logger.h> |
|
|
#include <fstream> |
|
|
#include "stdio.h" |
|
9 |
extern "C" { |
extern "C" { |
10 |
#include "CRC.h" |
#include "CRC.h" |
11 |
} |
} |
|
|
|
12 |
#include "ReaderAlgorithms.h" |
#include "ReaderAlgorithms.h" |
13 |
|
|
|
using namespace pamela; |
|
14 |
using namespace pamela::techmodel; |
using namespace pamela::techmodel; |
15 |
|
|
16 |
static log4cxx::LoggerPtr logger = log4cxx::Logger::getLogger(_T("pamela.techmodel.TsbTReader")); |
static log4cxx::LoggerPtr logger = log4cxx::Logger::getLogger(_T("pamela.techmodel.TsbTReader")); |
27 |
* Get a string with the version info of the algorithm. |
* Get a string with the version info of the algorithm. |
28 |
*/ |
*/ |
29 |
std::string TsbTReader::GetVersionInfo(void) const { |
std::string TsbTReader::GetVersionInfo(void) const { |
30 |
return "$Header: /home/cvsmanager/yoda/techmodel/TsbTReader.cpp,v 2.1 2005/03/03 13:12:18 kusanagi Exp $\n"; |
return "$Header: /home/cvsmanager/yoda/techmodel/TsbTReader.cpp,v 6.0 2006/02/07 17:11:10 kusanagi Exp $\n"; |
31 |
} |
} |
32 |
|
|
33 |
/** |
/** |
35 |
* event reader routines for all packet types. |
* event reader routines for all packet types. |
36 |
*/ |
*/ |
37 |
void TsbTReader::Init(PamelaRun *run) { |
void TsbTReader::Init(PamelaRun *run) { |
38 |
|
logger->debug(_T("Initialize")); |
39 |
SetInputStream(run); |
SetInputStream(run); |
40 |
run->WriteSubPacket(this, &TsbT, TsbT->Class()); |
run->WriteSubPacket(this, &TsbT, TsbT->Class()); |
41 |
} |
} |
46 |
void TsbTReader::RunEvent(int EventNumber, long int length) throw (WrongCRCException){ |
void TsbTReader::RunEvent(int EventNumber, long int length) throw (WrongCRCException){ |
47 |
|
|
48 |
char subData[length]; |
char subData[length]; |
49 |
UINT16 subCRC; //CRC of the data |
UINT16 subCRC; //calculated CRC of the data |
50 |
UINT16 readCRC; //CRC read from the end of the subpacket |
UINT16 readCRC; //CRC read from the end of the subpacket |
51 |
long int dataLength = length - 2; |
long int dataLength = length - 2; //the block of data |
52 |
int vars; |
|
53 |
|
InputFile->read(subData, sizeof(subData)); |
54 |
InputFile->read(subData, sizeof(unsigned char)*length); |
subCRC = CM_Compute_CRC16(0, (UINT8*)subData, dataLength); |
|
subCRC = CM_Compute_CRC16(0, (BYTE*)subData, dataLength); |
|
55 |
readCRC = (((UINT16)(subData[length - 2]<<8))&0xFF00) + (((UINT16)subData[length - 1])&0x00FF); |
readCRC = (((UINT16)(subData[length - 2]<<8))&0xFF00) + (((UINT16)subData[length - 1])&0x00FF); |
56 |
|
|
57 |
if (subCRC != readCRC) throw WrongCRCException(" Wrong CRC for TsbT Packet "); |
if (subCRC != readCRC) throw WrongCRCException(" Wrong CRC for TsbT Packet "); |
58 |
|
/*if (subCRC != readCRC) { |
59 |
TsbTRecord* rec; |
throw WrongCRCException("WRONG CRC FOR TsbT PACKET."); |
60 |
|
}*/ |
61 |
|
|
62 |
|
TsbTRecord* rec; |
63 |
TsbT->Records->Clear(); |
TsbT->Records->Clear(); |
64 |
TClonesArray &recs = *(TsbT->Records); |
TClonesArray &recs = *(TsbT->Records); |
65 |
|
|
70 |
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); |
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); |
71 |
rec->STATUS_CODE = subData[offset+4]; |
rec->STATUS_CODE = subData[offset+4]; |
72 |
for (int j=0; j < 13; j++){ |
for (int j=0; j < 13; j++){ |
73 |
rec->TEMPERATURES[j] = ((((UINT16)subData[offset+5+j]<<8)&0xFF00) + (((UINT16)subData[offset+6+j])&0x00FF)); |
rec->TEMPERATURES[j] = ((((UINT16)subData[offset+5+(2*j)]<<8)&0xFF00) + (((UINT16)subData[offset+6+(2*j)])&0x00FF)); |
74 |
} |
} |
75 |
offset = offset + 31; |
offset = offset + 31; |
76 |
} |
} |
77 |
//delete [] subData; |
} |
|
} |
|
78 |
|
|