#define BYTE  unsigned char
#include <string>
#include <log4cpp/Category.hh>
#include <fstream>
#include "stdio.h"
extern "C" {
#include "CRC.h"  
    //Struct per il passaggio di dati da e verso la chiamata fortran
    extern struct {
        int IEV2;
        int calped[4][11][96];
        int calgood[4][11][96];
        int calthr[4][11][6];
        int calrms[4][11][96];
        int calbase[4][11][6];
        int calvar[4][11][96];
        int calpuls[4][11][96];
    } calib_; 
    
    //external declaration of the Fortran function 
    void calpedestal_(short[], long int*, int*);
}

#include "ReaderAlgorithms.h"

#include "event/CalibCalPedEvent.h"

using namespace pamela;
using namespace pamela::techmodel;

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

/**
 * Constructor. 
 */
CalibCalPedReader::CalibCalPedReader(void): 
  TechmodelAlgorithm(PacketType::Log, "TechmodelCalibCalPedReader") { 
  cat <<  log4cpp::Priority::DEBUG
      <<  "Constructor "
      <<  "\n " << log4cpp::CategoryStream::ENDLINE;
  calibCalPed = new CalibCalPedEvent();
}

/**
 * Get a string with the version info of the algorithm.
 */
std::string CalibCalPedReader::GetVersionInfo(void) const {
  return 
    "$Header: /home/cvsmanager/yoda/techmodel/CalibCalPedReader.cpp,v 1.4 2004/08/19 15:24:46 kusanagi Exp $\n";
}

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

/**
 * Unpack the CalibCalPed event from an input file.
 */
void CalibCalPedReader::RunEvent(int EventNumber, long int length) {
 
    char        packetData[length-2];
    char        CRCevent[2];
    UINT16      calculatedCRC    = 0;   //calculated CRC
    UINT16      readCRC          = 0;   //read CRC
    long int    dataLength;
    int         ERROR;

    dataLength = length - 2;
    InputFile->read(packetData, sizeof(packetData));
    InputFile->read(CRCevent, sizeof(CRCevent));

    calculatedCRC = CM_Compute_CRC16(0, (BYTE*)packetData, dataLength);
    readCRC = ((UINT16)(CRCevent[0]<<8)&0xFF00) + ((UINT16)(CRCevent[1])&0x00FF);
    
    if (calculatedCRC == readCRC) {
        calpedestal_((short*)packetData, &dataLength, &ERROR);
        if (ERROR != 0) {
            char *errmsg;
            switch (ERROR){
                case 1: errmsg = "CALORIMETER NOT FOUND";
            }
            cat <<  log4cpp::Priority::ERROR
                <<  "Fortran77 function calpedestal error code = " << ERROR
                <<  errmsg
                <<  "\n " << log4cpp::CategoryStream::ENDLINE;
        } else {
          //Store the unpacked data
            calibCalPed->IEV2 = calib_.IEV2;
        //--------have to invert array because of FORTRAN <-> C different management of the indexes
            int tempCalped[96][11][4];
            int tempCalgood[96][11][4];
            int tempCalthr[6][11][4];
            int tempCalrms[96][11][4];
            int tempCalbase[6][11][4];
            int tempCalvar[6][11][4];
            int tempCalpuls[96][11][4];

            memcpy(tempCalped,  calib_.calped,  sizeof(tempCalped));
            memcpy(tempCalgood, calib_.calgood, sizeof(tempCalgood));
            memcpy(tempCalthr,  calib_.calthr,  sizeof(tempCalthr));
            memcpy(tempCalrms,  calib_.calrms,  sizeof(tempCalrms));
            memcpy(tempCalbase, calib_.calbase, sizeof(tempCalbase));
            memcpy(tempCalvar,  calib_.calvar,  sizeof(tempCalvar));
            memcpy(tempCalpuls, calib_.calpuls, sizeof(tempCalpuls));

            for (int i = 0; i < 4; i++){
                for (int j = 0; j <11; j++){
                    for (int z = 0; z < 96; z++){
                        calibCalPed->calped[i][j][z]    = tempCalped[z][j][i];
                        calibCalPed->calgood[i][j][z]   = tempCalgood[z][j][i];
                        calibCalPed->calrms[i][j][z]    = tempCalrms[z][j][i];
                        calibCalPed->calpuls[i][j][z]    = tempCalpuls[z][j][i];
                    }
                }
            }

            for (int i = 0; i < 4; i++){
                for (int j = 0; j <11; j++){
                    for (int z = 0; z < 6; z++){
                        calibCalPed->calthr[i][j][z]    = tempCalthr[z][j][i];
                        calibCalPed->calbase[i][j][z]   = tempCalbase[z][j][i];
                        calibCalPed->calvar[i][j][z]    = tempCalvar[z][j][i];
                    }
                }
            }
        //-----------------------------------------------------------------------------------------
        }
    } else {
            cat <<  log4cpp::Priority::ERROR
            <<  "The test of calculated CRC with one wrote on file FAILED!!"
            <<  "\n " << log4cpp::CategoryStream::ENDLINE;    
    }
    free(packetData);
}