/** @file
 * $Source: /home/cvsmanager/yoda/techmodel/CalibS4Reader.cpp,v $
 * $Id: CalibS4Reader.cpp,v 2.0 2004/09/21 20:50:54 kusanagi Exp $
 * $Author: kusanagi $
 * 
 * Implementation of the LogReader class.
* ToBeDone:
* Control the CRC for the entire data Packet not just for single records
 */

#define UINT unsigned int
#define BYTE  unsigned char
#include <string>
#include <log4cxx/logger.h>
extern "C" {
#include <sys/time.h>
#include "CRC.h"
}

#include <fstream>
#include "stdio.h"
#include "ReaderAlgorithms.h"

#include "event/CalibS4Event.h"

using namespace pamela;
using namespace pamela::techmodel;

static log4cxx::LoggerPtr logger = log4cxx::Logger::getLogger(_T("pamela.techmodel.CalibS4Reader"));

/**
 * Constructor. 
 */
CalibS4Reader::CalibS4Reader(void): 
  TechmodelAlgorithm(PacketType::Log, "TechmodelCalibS4Reader") { 
  logger->debug(_T("Constructor"));
  CalibS4 = new CalibS4Event();
}

/**
 * Get a string with the version info of the algorithm.
 */
std::string CalibS4Reader::GetVersionInfo(void) const {
  return 
    "$Header: /home/cvsmanager/yoda/techmodel/CalibS4Reader.cpp,v 2.0 2004/09/21 20:50:54 kusanagi Exp $\n";
}

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

/**
 * Unpack the CalibS4 event from an input file.
 */
void CalibS4Reader::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);
    
    if (subCRC == readCRC){
        for (int i = 0; i < 384; i++){
            CalibS4->S4register[i]  = ((UINT16)subData[i*6] + (UINT16)subData[(i*6)+1])&0x0FFF;
            CalibS4->S4command[i]   = (BYTE)subData[(i*6)+2];
            CalibS4->S4length[i]    = ((UINT16)subData[(i*6)+3])&0xFF00 + ((UINT16)subData[(i*6)+4])&0x00FF;
            CalibS4->S4crc[i]       = (BYTE)subData[(i*6)+5];
        }
    } else {
        logger->warn(_T("Wrong CRC for CalibS4 Packet "));
    }
}