| 1 |
mocchiut |
1.1 |
/** @file |
| 2 |
|
|
* $Source: /repository/PamOffLineSW/techmodel/CalibS4Reader.cpp,v $ |
| 3 |
|
|
* $Id: CalibS4Reader.cpp,v 1.5 2008-03-04 18:09:30 messineo Exp $ |
| 4 |
|
|
* $Author: messineo $ |
| 5 |
|
|
* |
| 6 |
|
|
* Implementation of the LogReader class. |
| 7 |
|
|
* ToBeDone: |
| 8 |
|
|
* Control the CRC for the entire data Packet not just for single records |
| 9 |
|
|
*/ |
| 10 |
|
|
|
| 11 |
|
|
|
| 12 |
|
|
extern "C" { |
| 13 |
|
|
#include "CRC.h" |
| 14 |
|
|
} |
| 15 |
|
|
#include "ReaderAlgorithms.h" |
| 16 |
|
|
|
| 17 |
|
|
using namespace pamela::techmodel; |
| 18 |
|
|
|
| 19 |
|
|
|
| 20 |
|
|
/** |
| 21 |
|
|
* Constructor. |
| 22 |
|
|
*/ |
| 23 |
|
|
CalibS4Reader::CalibS4Reader(void): |
| 24 |
|
|
TechmodelAlgorithm(PacketType::Log, "TechmodelCalibS4Reader") { |
| 25 |
|
|
calibS4 = new CalibS4Event(); |
| 26 |
|
|
} |
| 27 |
|
|
|
| 28 |
|
|
/** |
| 29 |
|
|
* Get a string with the version info of the algorithm. |
| 30 |
|
|
*/ |
| 31 |
|
|
std::string CalibS4Reader::GetVersionInfo(void) const { |
| 32 |
|
|
return |
| 33 |
|
|
"$Header: /repository/PamOffLineSW/techmodel/CalibS4Reader.cpp,v 1.5 2008-03-04 18:09:30 messineo Exp $\n"; |
| 34 |
|
|
} |
| 35 |
|
|
|
| 36 |
|
|
/** |
| 37 |
|
|
* Initialize the algorithm with a special run. This will initialize the |
| 38 |
|
|
* event reader routines for all packet types. |
| 39 |
|
|
*/ |
| 40 |
|
|
void CalibS4Reader::Init(PamelaRun *run) { |
| 41 |
|
|
|
| 42 |
|
|
run->WriteSubPacket(this, &calibS4, calibS4->Class()); |
| 43 |
|
|
} |
| 44 |
|
|
|
| 45 |
|
|
/** |
| 46 |
|
|
* Unpack the CalibS4 event |
| 47 |
|
|
*/ |
| 48 |
|
|
void CalibS4Reader::PKT_RunEvent(char* subData, long int length) throw (WrongCRCException){ |
| 49 |
|
|
std::stringstream oss; |
| 50 |
|
|
string msg; |
| 51 |
|
|
|
| 52 |
|
|
int offset; |
| 53 |
|
|
UINT16 subCRC; //CRC of the data |
| 54 |
|
|
UINT16 readCRC; //CRC read from the end of the subpacket |
| 55 |
|
|
int numRecords = ((length - 2)/6); |
| 56 |
|
|
S4::S4Event* rec; |
| 57 |
|
|
calibS4->Records->Clear(); |
| 58 |
|
|
TClonesArray &recs = *(calibS4->Records); |
| 59 |
|
|
|
| 60 |
|
|
subCRC = CM_Compute_CRC16(0, (BYTE*)subData, length - 2); |
| 61 |
|
|
readCRC = (((UINT16)(subData[length - 2]<<8))&0xFF00) + (((UINT16)subData[length - 1])&0x00FF); |
| 62 |
|
|
|
| 63 |
|
|
//TODO:check here .... |
| 64 |
|
|
//ORIG: if (subCRC != readCRC) throw WrongCRCException(" Wrong CRC for CalibS4 Packet "); |
| 65 |
|
|
if (subCRC != readCRC) |
| 66 |
|
|
{ |
| 67 |
|
|
oss.str(""); |
| 68 |
|
|
oss<<"Wrong CRC for CalibS4 Packet: "<<" CRC COMPUTED= "<< subCRC<<" CRC READ= "<< readCRC; |
| 69 |
|
|
msg=oss.str(); |
| 70 |
|
|
PamOffLineSW::mainLogUtil->logError(msg); |
| 71 |
|
|
throw WrongCRCException(" Wrong CRC for CalibS4 Packet. THE PACKET IS DISCARDED "); |
| 72 |
|
|
} |
| 73 |
|
|
|
| 74 |
|
|
for(int i = 0; i < numRecords; i++) { |
| 75 |
|
|
offset = i*6; |
| 76 |
|
|
rec = new(recs[i]) S4::S4Event(); //add a new S4Event |
| 77 |
|
|
rec->S4_REG_STATUS = (((UINT8)subData[offset])&0xF0); |
| 78 |
|
|
rec->S4_DATA = ((((UINT16)subData[offset]<<8)&0x0FFF) + (((UINT16)subData[offset+1])&0x00FF)); |
| 79 |
|
|
rec->S4_CMD_NUM = (((UINT8)subData[offset+2])&0xFF); |
| 80 |
|
|
rec->S4_RESP_LENGHT = ((((UINT16)subData[offset+3]<<8)&0xFF00) + (((UINT16)subData[offset+4])&0x00FF)); |
| 81 |
|
|
rec->S4_OVERALL_CHKCODE = (((UINT8)subData[offset+5])&0xFF); |
| 82 |
|
|
} |
| 83 |
|
|
/* |
| 84 |
|
|
if (subCRC != readCRC) |
| 85 |
|
|
{ |
| 86 |
|
|
oss.str(""); |
| 87 |
|
|
oss<<"Wrong CRC for CalibS4 Packet: "<<" CRC COMPUTED= "<< subCRC<<" CRC READ= "<< readCRC; |
| 88 |
|
|
msg=oss.str(); |
| 89 |
|
|
PamOffLineSW::mainLogUtil->logWarning(msg); |
| 90 |
|
|
throw WrongCRCException_PKTUsed(" Wrong CRC for CalibS4 Packet. "); |
| 91 |
|
|
} |
| 92 |
|
|
*/ |
| 93 |
|
|
|
| 94 |
|
|
} |
| 95 |
|
|
|
Parent Directory
| 
Revision Log