/** @file
 * $Source: /home/cvsmanager/yoda/techmodel/ArrDumpReader.cpp,v $
 * $Id: ArrDumpReader.cpp,v 1.2 2004/07/17 20:03:38 kusanagi Exp $
 * $Author: kusanagi $
 * 
 * Implementation of the ArrDumpReader class.
 */

#include <string>
#include <log4cpp/Category.hh>
#include <fstream>
#include "stdio.h"
extern "C" {
    #include "CRC.h"
}

#include "ReaderAlgorithms.h"

using namespace pamela;
using namespace pamela::techmodel;

static log4cpp::Category& cat = log4cpp::Category::getInstance("pamela.techmodel.ArrDumpReader");  

/**
 * Constructor. 
 */
ArrDumpReader::ArrDumpReader(void): 
  TechmodelAlgorithm(PacketType::ArrDump, "TechmodelArrDump") { 
  ArrDump = new ArrDumpEvent();
}

/**
 * Get a string with the version info of the algorithm.
 */
std::string ArrDumpReader::GetVersionInfo(void) const {
  return "$Header: /home/cvsmanager/yoda/techmodel/ArrDumpReader.cpp,v 1.2 2004/07/17 20:03:38 kusanagi Exp $\n";
}

/**
 * Initialize the algorithm with a special run. This will initialize the
 * event reader routines for all packet types.
 */
void ArrDumpReader::Init(PamelaRun *run) {
  SetInputStream(run);
  run->WriteSubPacket(this, &ArrDump, ArrDump->Class());
}

/**
 * Unpack the ArrDump event from an input file.
 */
void ArrDumpReader::RunEvent(int EventNumber, long int length) {
  
  char     *subData;
  char      eventCRC[2];
  UINT16    subCRC;      //CRC of the data
  UINT16    readCRC;     //CRC read from the end of the subpacket
  long int  dataLength;
  
    //the 2 bytes subtracted belong to the final event CRC bytes
    dataLength = length - (long int)2;

    subData = new char[dataLength];
    InputFile->read(subData, sizeof(unsigned char)*dataLength);
    subCRC = CM_Compute_CRC16(0, (BYTE*)subData, dataLength);

    //took the final CRC to compare it with the previous calculated CRC of the data
    InputFile->read(eventCRC, sizeof(eventCRC));
    readCRC = (((UINT16)(eventCRC[0]<<8))&0xFF00) + (((UINT16)eventCRC[1])&0x00FF);
    
    //finally check if the RecordCRC is correct and finally update the partialCRC
    if (subCRC == readCRC){
        ArrDumpRecord* rec;
        long int offset = 0;
        int i = 0;
        int size;
        ArrDump->Records->Clear();
        TClonesArray &recs = *(ArrDump->Records);
        while (offset < dataLength){
            rec = new(recs[i++]) ArrDumpRecord(); //add a new TmtcRecord
            rec->Arr_ID  = ((UINT8)subData[offset])&0xFF;
            rec->Arr_len = (((UINT16)subData[offset+1]<<8)&0xFF00) + ((UINT16)subData[offset+2])&0x00FF;
            rec->Data = new UINT32[rec->Arr_len];
            size = sizeof(UINT32)*(rec->Arr_len);
            memcpy(rec->Data, (UINT32*)(subData+offset+3), size);
            offset = offset + size + 3;
        }
        free(subData);
    } else {
        cat <<  log4cpp::Priority::ERROR
            <<  "Wrong CRC on Subpacket in ArrDump Packet "
            <<  "\n " << log4cpp::CategoryStream::ENDLINE;
    }
  }