PamOffLineSW/techmodel/McmdReader.cpp

/** @file
 * $Source: /repository/PamOffLineSW/techmodel/McmdReader.cpp,v $
 * $Id: McmdReader.cpp,v 1.7 2008-03-06 18:33:36 messineo Exp $
 * $Author: messineo $
 * 
 * Implementation of the McmdReader class.
 */

extern "C" {
        #include "CRC.h"
}
#include "ReaderAlgorithms.h"
using namespace pamela::techmodel;

/**
 * Constructor. 
 */
McmdReader::McmdReader(void): 
  TechmodelAlgorithm(PacketType::Mcmd, "Mcmd") { 
  Mcmd = new McmdEvent();
}

/**
 * Get a string with the version info of the algorithm.
 */
std::string McmdReader::GetVersionInfo(void) const {
  return 
    "$Header: /repository/PamOffLineSW/techmodel/McmdReader.cpp,v 1.7 2008-03-06 18:33:36 messineo Exp $\n";
}

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

/**
 * Unpack the Mcmd event
 *  Each subpacket is prafaceded by 4 OBT bytes.
 *  The elementar structure is a kind of 
 * --------CPU - OBT---------------------------------
 *  OBT     - 4 Bytes
 * --------Start Sub-Packet---------------------------------
 *  SeqID  - 2 Bytes
 *  T          - 1 bit       | spare  - 7 bits | Mcmd-ID - 1 byte
 *  Spare  - 4 bits     | Mcmd Lenght 12 bits
 *  Time Tag      - 4 Bytes
 *  DATA            - McmdLength * 2 Bytes
 *  don't care    - 1 Byte
 *  END-ID         - 1 Byte is the sum of subPacket Bytes module 256
 * --------End Sub-Packet---------------------------------
 * --------CPU CRC-16 on OBT + subPacket---------------------------------
 * subCRC        - 2 Bytes
 * this structure is repeated one or more times.
 * The last 2 Bytes are CRC16 computed by CPU on all previous (OBT + subpacket data + subCRC) repetitions

 * @Event Number
 * @length is the size in bytes of the event (or packet)
 */
void McmdReader::PKT_RunEvent(char* mysubData, long int length) throw (WrongCRCException_PKTUsed)
{          
        stringstream oss;
        string msg;     
        
        int i = 0;
        const int obt_len = 4;
        const int subHeader_len = 10;
        const int subTrailer_len = 2;
        const int subPckCRC_len = 2;
        long int  dataLength= 0;

        char OBT[obt_len]={0};
        char subHeader[subHeader_len]={0};
        char subTrailer[subTrailer_len]={0};
        char subPckCRC[subPckCRC_len]={0};
        char* subData=NULL;

        UINT16    subCRC= 0;      //CRC of the subpacket (updated as subPckt is read)
        UINT16    readCRC= 0;     //CRC read from the subpacket
        UINT16    partialCRC= 0; //partial CRC updated as mcmd packet is read (to compare with CRC read in the total Mcmd header)
        McmdRecord *rec;
  
        Mcmd->Records->Clear();
        TClonesArray &recs = *(Mcmd->Records);

        int start=0;
  
        while(start < (length-2-obt_len-subTrailer_len-subTrailer_len-subPckCRC_len)) 
        {
                //Read the OBT preceeding the subpacket then calculate a partial CRC for it
                //and update the partialCRC 
                for(int m=start; m<obt_len; m++){
                  OBT[m-start]=mysubData[m];
                }               
                start+=obt_len;
                
                subCRC = CM_Compute_CRC16(0, (BYTE*)&OBT, obt_len);
                partialCRC = CM_Compute_CRC16(partialCRC, (BYTE*)&OBT, obt_len);
                //Read the header for the subPacket and read mcmdLength 
                //12 is the total lenght of subHeader + subTrailer
                for(int m=start; m<subHeader_len; m++){
                   subHeader[m-start]=mysubData[m];
                }               
                start+=subHeader_len;
        
            subCRC = CM_Compute_CRC16(subCRC, (BYTE*)&subHeader, subHeader_len);
            partialCRC = CM_Compute_CRC16(partialCRC, (BYTE*)&subHeader, subHeader_len);          
            dataLength = (((0x0fff)&((UINT16)subHeader[4]))<<8|((UINT16)subHeader[5])*2) - subHeader_len - subTrailer_len;  
            //the line below is exactly how it was in the original version
            if (dataLength < 0) break; //it should throw an exception ***TBD***
            //I add also this check
            if (dataLength + start > (length-2-subTrailer_len-subPckCRC_len))
            {
                 oss.str("");
                     oss<<"MCMD: Error in the MCMD Packet lenght, it is not " <<length;
                 msg=oss.str();
                 PamOffLineSW::mainLogUtil->logWarning(msg);                    
                break; //it should throw an exception ***TBD***
            } 
            
            //read subpacket data according to data length then calculate partial CRC for data
             //and update the partialCRC
              
           subData = new char[dataLength];
           for(int m=start; m<dataLength; m++){
                   subData[m-start]=mysubData[m];
             }
           start+=dataLength;
           
           for (int jj = 0; jj < dataLength ; jj++){
               subCRC = CM_Compute_CRC16(subCRC, (BYTE*)(subData+jj), 1);
               partialCRC = CM_Compute_CRC16(partialCRC, (BYTE*)(subData+jj), 1);
           }
        
           //Read the CRC inside of MCMD
           //To check sum of all sub packet data, module 256 ****TBD****
           for(int m=start; m<subTrailer_len; m++){
                   subTrailer[m-start]=mysubData[m];
            }
           start+=subTrailer_len;
        
           subCRC = CM_Compute_CRC16(subCRC, (BYTE*)&subTrailer, 2);
           partialCRC = CM_Compute_CRC16(partialCRC, (BYTE*)&subTrailer, 2);    
           //Read the CRC of subPacket      
           for(int m=start; m<subPckCRC_len; m++){
                        subPckCRC[m-start]=mysubData[m];
           }
           start+=subPckCRC_len;
        
           partialCRC = CM_Compute_CRC16(partialCRC, (BYTE*)&subPckCRC, 2);
           readCRC = (((BYTE)subPckCRC[0])<<8) + ((BYTE)subPckCRC[1]);  
        
          //finally check if the RecordCRC is correct
         //and finally update the partialCRC
         //TO DO - if one CRC is wrong also the total one will be corrupted
           if (subCRC == readCRC){
             rec                  = new(recs[i++]) McmdRecord(); //aggiungo un nuovo McmdRecord all'evento
             rec->MCMD_RECORD_OBT = (((UINT32)OBT[0]<<24)&0xFF000000) + (((UINT32)OBT[1]<<16)&0x00FF0000) +  (((UINT32)OBT[2]<<8)&0x0000FF00) + (((UINT32)OBT[3])&0x000000FF);
             rec->SeqID           = (((BYTE)subHeader[0]<<8)&0xFF00) + (((BYTE)subHeader[1])&0x00FF);
             rec->Tbit            = ((BYTE)((subHeader[2]&0x80))>>7);
             rec->ID1             = (BYTE)subHeader[3];
             rec->McmdLength      = (0x0fff)&(((UINT16)(subHeader[4]<<8)) + ((UINT16)subHeader[5]));
             rec->TimeTag         = (((UINT32)OBT[6]<<24)&0xFF000000) + (((UINT32)OBT[7]<<16)&0x00FF0000) +  (((UINT32)OBT[8]<<8)&0x0000FF00) + (((UINT32)OBT[9])&0x000000FF);
             rec->endID           = (BYTE)subTrailer[1];
        
             rec->McmdData        = new TArrayC(dataLength, subData);
        //     delete [] subData;
           } else {
                   oss.str("");
                   oss << "Wrong CRC on Subpacket internal to MCMD Packet ";
                   msg=oss.str();
                   PamOffLineSW::mainLogUtil->logAll(msg);      
           }
         
           delete [] subData;
        }

        if(start!=length-2)
        {    
                oss.str("");
                oss<<"MCMD: Error in the MCMD Packet lenght, it is not " <<length;
                msg=oss.str();
                PamOffLineSW::mainLogUtil->logWarning(msg);     
        }
        
        //in the end compare the calculated partial CRC with the MCMD packet CRC
        readCRC = (((UINT16)(mysubData[length - 2]<<8))&0xFF00) + (((UINT16)mysubData[length - 1])&0x00FF);  

//      if(partialCRC != readCRC) throw WrongCRCException(" Wrong Global CRC for MCMD Packet ");
        if (partialCRC != readCRC)
        {
                oss.str("");
                oss<<"Wrong CRC for MCMD Packet: "<<" CRC COMPUTED= "<< partialCRC<<" CRC READ=  "<< readCRC;
                msg=oss.str();
                PamOffLineSW::mainLogUtil->logWarning(msg);     
                throw WrongCRCException_PKTUsed(" Wrong CRC for MCMD Packet. ");
        }
}
1	mocchiut	1.1	/** @file
2			* $Source: /repository/PamOffLineSW/techmodel/McmdReader.cpp,v $
3			* $Id: McmdReader.cpp,v 1.7 2008-03-06 18:33:36 messineo Exp $
4			* $Author: messineo $
5			*
6			* Implementation of the McmdReader class.
7			*/
8
9			extern "C" {
10			#include "CRC.h"
11			}
12			#include "ReaderAlgorithms.h"
13			using namespace pamela::techmodel;
14
15			/**
16			* Constructor.
17			*/
18			McmdReader::McmdReader(void):
19			TechmodelAlgorithm(PacketType::Mcmd, "Mcmd") {
20			Mcmd = new McmdEvent();
21			}
22
23			/**
24			* Get a string with the version info of the algorithm.
25			*/
26			std::string McmdReader::GetVersionInfo(void) const {
27			return
28			"$Header: /repository/PamOffLineSW/techmodel/McmdReader.cpp,v 1.7 2008-03-06 18:33:36 messineo Exp $\n";
29			}
30
31			/**
32			* Initialize the algorithm with a special run. This will initialize the
33			* event reader routines for all packet types.
34			*/
35			void McmdReader::Init(PamelaRun *run) {
36			// logger->debug(_T("Initialize"));
37			// SetInputStream(run);
38			run->WriteSubPacket(this, &Mcmd, Mcmd->Class());
39			}
40
41			/**
42			* Unpack the Mcmd event
43			* Each subpacket is prafaceded by 4 OBT bytes.
44			* The elementar structure is a kind of
45			* --------CPU - OBT---------------------------------
46			* OBT - 4 Bytes
47			* --------Start Sub-Packet---------------------------------
48			* SeqID - 2 Bytes
49			* T - 1 bit \| spare - 7 bits \| Mcmd-ID - 1 byte
50			* Spare - 4 bits \| Mcmd Lenght 12 bits
51			* Time Tag - 4 Bytes
52			* DATA - McmdLength * 2 Bytes
53			* don't care - 1 Byte
54			* END-ID - 1 Byte is the sum of subPacket Bytes module 256
55			* --------End Sub-Packet---------------------------------
56			* --------CPU CRC-16 on OBT + subPacket---------------------------------
57			* subCRC - 2 Bytes
58			* this structure is repeated one or more times.
59			* The last 2 Bytes are CRC16 computed by CPU on all previous (OBT + subpacket data + subCRC) repetitions
60
61			* @Event Number
62			* @length is the size in bytes of the event (or packet)
63			*/
64			void McmdReader::PKT_RunEvent(char* mysubData, long int length) throw (WrongCRCException_PKTUsed)
65			{
66			stringstream oss;
67			string msg;
68
69			int i = 0;
70			const int obt_len = 4;
71			const int subHeader_len = 10;
72			const int subTrailer_len = 2;
73			const int subPckCRC_len = 2;
74			long int dataLength= 0;
75
76			char OBT[obt_len]={0};
77			char subHeader[subHeader_len]={0};
78			char subTrailer[subTrailer_len]={0};
79			char subPckCRC[subPckCRC_len]={0};
80			char* subData=NULL;
81
82			UINT16 subCRC= 0; //CRC of the subpacket (updated as subPckt is read)
83			UINT16 readCRC= 0; //CRC read from the subpacket
84			UINT16 partialCRC= 0; //partial CRC updated as mcmd packet is read (to compare with CRC read in the total Mcmd header)
85			McmdRecord *rec;
86
87			Mcmd->Records->Clear();
88			TClonesArray &recs = *(Mcmd->Records);
89
90			int start=0;
91
92			while(start < (length-2-obt_len-subTrailer_len-subTrailer_len-subPckCRC_len))
93			{
94			//Read the OBT preceeding the subpacket then calculate a partial CRC for it
95			//and update the partialCRC
96			for(int m=start; m<obt_len; m++){
97			OBT[m-start]=mysubData[m];
98			}
99			start+=obt_len;
100
101			subCRC = CM_Compute_CRC16(0, (BYTE*)&OBT, obt_len);
102			partialCRC = CM_Compute_CRC16(partialCRC, (BYTE*)&OBT, obt_len);
103			//Read the header for the subPacket and read mcmdLength
104			//12 is the total lenght of subHeader + subTrailer
105			for(int m=start; m<subHeader_len; m++){
106			subHeader[m-start]=mysubData[m];
107			}
108			start+=subHeader_len;
109
110			subCRC = CM_Compute_CRC16(subCRC, (BYTE*)&subHeader, subHeader_len);
111			partialCRC = CM_Compute_CRC16(partialCRC, (BYTE*)&subHeader, subHeader_len);
112			dataLength = (((0x0fff)&((UINT16)subHeader[4]))<<8\|((UINT16)subHeader[5])*2) - subHeader_len - subTrailer_len;
113			//the line below is exactly how it was in the original version
114			if (dataLength < 0) break; //it should throw an exception *TBD*
115			//I add also this check
116			if (dataLength + start > (length-2-subTrailer_len-subPckCRC_len))
117			{
118			oss.str("");
119			oss<<"MCMD: Error in the MCMD Packet lenght, it is not " <<length;
120			msg=oss.str();
121			PamOffLineSW::mainLogUtil->logWarning(msg);
122			break; //it should throw an exception *TBD*
123			}
124
125			//read subpacket data according to data length then calculate partial CRC for data
126			//and update the partialCRC
127
128			subData = new char[dataLength];
129			for(int m=start; m<dataLength; m++){
130			subData[m-start]=mysubData[m];
131			}
132			start+=dataLength;
133
134			for (int jj = 0; jj < dataLength ; jj++){
135			subCRC = CM_Compute_CRC16(subCRC, (BYTE*)(subData+jj), 1);
136			partialCRC = CM_Compute_CRC16(partialCRC, (BYTE*)(subData+jj), 1);
137			}
138
139			//Read the CRC inside of MCMD
140			//To check sum of all sub packet data, module 256 **TBD**
141			for(int m=start; m<subTrailer_len; m++){
142			subTrailer[m-start]=mysubData[m];
143			}
144			start+=subTrailer_len;
145
146			subCRC = CM_Compute_CRC16(subCRC, (BYTE*)&subTrailer, 2);
147			partialCRC = CM_Compute_CRC16(partialCRC, (BYTE*)&subTrailer, 2);
148			//Read the CRC of subPacket
149			for(int m=start; m<subPckCRC_len; m++){
150			subPckCRC[m-start]=mysubData[m];
151			}
152			start+=subPckCRC_len;
153
154			partialCRC = CM_Compute_CRC16(partialCRC, (BYTE*)&subPckCRC, 2);
155			readCRC = (((BYTE)subPckCRC[0])<<8) + ((BYTE)subPckCRC[1]);
156
157			//finally check if the RecordCRC is correct
158			//and finally update the partialCRC
159			//TO DO - if one CRC is wrong also the total one will be corrupted
160			if (subCRC == readCRC){
161			rec = new(recs[i++]) McmdRecord(); //aggiungo un nuovo McmdRecord all'evento
162			rec->MCMD_RECORD_OBT = (((UINT32)OBT[0]<<24)&0xFF000000) + (((UINT32)OBT[1]<<16)&0x00FF0000) + (((UINT32)OBT[2]<<8)&0x0000FF00) + (((UINT32)OBT[3])&0x000000FF);
163			rec->SeqID = (((BYTE)subHeader[0]<<8)&0xFF00) + (((BYTE)subHeader[1])&0x00FF);
164			rec->Tbit = ((BYTE)((subHeader[2]&0x80))>>7);
165			rec->ID1 = (BYTE)subHeader[3];
166			rec->McmdLength = (0x0fff)&(((UINT16)(subHeader[4]<<8)) + ((UINT16)subHeader[5]));
167			rec->TimeTag = (((UINT32)OBT[6]<<24)&0xFF000000) + (((UINT32)OBT[7]<<16)&0x00FF0000) + (((UINT32)OBT[8]<<8)&0x0000FF00) + (((UINT32)OBT[9])&0x000000FF);
168			rec->endID = (BYTE)subTrailer[1];
169
170			rec->McmdData = new TArrayC(dataLength, subData);
171			// delete [] subData;
172			} else {
173			oss.str("");
174			oss << "Wrong CRC on Subpacket internal to MCMD Packet ";
175			msg=oss.str();
176			PamOffLineSW::mainLogUtil->logAll(msg);
177			}
178
179			delete [] subData;
180			}
181
182			if(start!=length-2)
183			{
184			oss.str("");
185			oss<<"MCMD: Error in the MCMD Packet lenght, it is not " <<length;
186			msg=oss.str();
187			PamOffLineSW::mainLogUtil->logWarning(msg);
188			}
189
190			//in the end compare the calculated partial CRC with the MCMD packet CRC
191			readCRC = (((UINT16)(mysubData[length - 2]<<8))&0xFF00) + (((UINT16)mysubData[length - 1])&0x00FF);
192
193			// if(partialCRC != readCRC) throw WrongCRCException(" Wrong Global CRC for MCMD Packet ");
194			if (partialCRC != readCRC)
195			{
196			oss.str("");
197			oss<<"Wrong CRC for MCMD Packet: "<<" CRC COMPUTED= "<< partialCRC<<" CRC READ= "<< readCRC;
198			msg=oss.str();
199			PamOffLineSW::mainLogUtil->logWarning(msg);
200			throw WrongCRCException_PKTUsed(" Wrong CRC for MCMD Packet. ");
201			}
202			}