| 1 | /** @file | 
| 2 | * $Source: /home/cvsmanager/yoda/techmodel/TsbBReader.cpp,v $ | 
| 3 | * $Id: TsbBReader.cpp,v 4.5 2005/08/29 09:32:28 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 4.5 2005/08/29 09:32:28 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 | logger->debug(_T("Initialize")); | 
| 45 | SetInputStream(run); | 
| 46 | run->WriteSubPacket(this, &TsbB, TsbB->Class()); | 
| 47 | } | 
| 48 |  | 
| 49 | /** | 
| 50 | * Unpack the TsbB event from an input file. | 
| 51 | */ | 
| 52 | void TsbBReader::RunEvent(int EventNumber, long int length) throw (WrongCRCException){ | 
| 53 |  | 
| 54 | char      subData[length]; | 
| 55 | UINT16    subCRC;      //calculated CRC of the data | 
| 56 | UINT16    readCRC;     //CRC read from the end of the subpacket | 
| 57 | long int  dataLength = length - 2; //the block of data | 
| 58 |  | 
| 59 | InputFile->read(subData, sizeof(subData)); | 
| 60 | subCRC  = CM_Compute_CRC16(0, (UINT8*)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 | TsbB->Records->Clear(); | 
| 67 | TClonesArray &recs = *(TsbB->Records); | 
| 68 |  | 
| 69 | int i = 0; | 
| 70 | long int offset = 0; | 
| 71 | while (offset < dataLength){ | 
| 72 | rec               = new(recs[i++]) TsbBRecord(); //add a new TsbB | 
| 73 | 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); | 
| 74 | rec->STATUS_CODE = subData[offset+4]; | 
| 75 | for (int j=0; j < 7; j++){ | 
| 76 | rec->B_FIELD[j]  = ((((UINT16)subData[offset+5+(2*j)]<<8)&0xFF00) + (((UINT16)subData[offset+6+(2*j)])&0x00FF)); | 
| 77 | } | 
| 78 | offset = offset + 19; | 
| 79 | } | 
| 80 | } | 
| 81 |  |