| 1 | 
/** @file | 
| 2 | 
 * $Source: /home/cvsmanager/yoda/techmodel/ArrDumpReader.cpp,v $ | 
| 3 | 
 * $Id: ArrDumpReader.cpp,v 1.4 2004/08/24 16:01:57 kusanagi Exp $ | 
| 4 | 
 * $Author: kusanagi $ | 
| 5 | 
 *  | 
| 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 | 
  return "$Header: /home/cvsmanager/yoda/techmodel/ArrDumpReader.cpp,v 1.4 2004/08/24 16:01:57 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 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 | 
        ArrDumpRecord* rec; | 
| 73 | 
        long int offset = 0; | 
| 74 | 
        int i = 0; | 
| 75 | 
        int size; | 
| 76 | 
        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 | 
            //rec->Data = new UINT32[rec->Arr_len]; | 
| 83 | 
            size = sizeof(UINT32)*(rec->Arr_len); | 
| 84 | 
            rec->Data  = new TArrayI((int)rec->Arr_len, (int*)(subData+offset+3)); | 
| 85 | 
            //memcpy(rec->Data, (UINT32*)(subData+offset+3), size); | 
| 86 | 
            offset = offset + size + 3; | 
| 87 | 
        } | 
| 88 | 
    } else { | 
| 89 | 
        cat <<  log4cpp::Priority::ERROR | 
| 90 | 
            <<  "Wrong CRC on Subpacket in ArrDump Packet " | 
| 91 | 
            <<  "\n " << log4cpp::CategoryStream::ENDLINE; | 
| 92 | 
    } | 
| 93 | 
    delete [] subData; | 
| 94 | 
  } |