chewbacca/PamOffLineSW/R3_FAFEDE_State.cpp

//where I am
#include "R3_FAFEDE_State.h"
//manager
#include "StateManager.h"
//home
#include "R0_Init_State.h"
//a step after
#include "R4_HEADER_State.h"

//to compute CRC
#include "CRC.h"

//to log something
//#include "Logger.h"

namespace PamOffLineSW
{
extern LogUtil* mainLogUtil;
extern long int iNumCadres; //cadre's number  
extern unsigned long long int iByte_tot;// how many bytes I have read till now  

R3_FAFEDE_State R3_FAFEDE_State::instance;
int R3_FAFEDE_State::posHeaderPKT=2;

R3_FAFEDE_State::R3_FAFEDE_State()
{       
        initHeaderPKT();                        
}

R3_FAFEDE_State::~R3_FAFEDE_State()
{
}

void R3_FAFEDE_State::initHeaderPKT()
{
        for(int j=0; j<LENGTH_HEADER_PKT; j++)
        {
                headerPKT[j]=0;
        }
        headerPKT[0]=CODE_FA;
        headerPKT[1]=CODE_FE;
        headerPKT[2]=CODE_DE;
        
        posHeaderPKT=2;
}

void R3_FAFEDE_State::resetHeaderPKT()
{       
        posHeaderPKT=2;
}

void R3_FAFEDE_State::readInput(char inputbyte)
{
//the three bytes before this one are 0xFA 0xFE 0xDE, we want to check if it is a Pamela Packet 
//to do this we read 16 bytes starting from  0xFA and compute the CRC
        posHeaderPKT++;
        headerPKT[posHeaderPKT]=inputbyte;      

        //if we have read all the header        
        if(posHeaderPKT==(LENGTH_HEADER_PKT-1))
        {
                //TODO: maybe if ex_pkt_type_1 != ex_pkt_type_2  the pkt is not good? maybe it shuold be discarded?
                // put this check here and if the pkt must can't be recognised 
                
                //here we check the CRC
                short int CalcCheckSum=(short int)(unsigned char)CM_Compute_CRC16(0, (unsigned char*)&headerPKT, LENGTH_HEADER_PKT-1); 

                //bytes when the PKT starts
                unsigned long long int wherePKT_start=iByte_tot-posHeaderPKT+1;

                //I check also that pkt_type is correct? headerPKT[3]=header[4] ??              
                if ((headerPKT[3]==headerPKT[4])&&(CalcCheckSum==(short int)(unsigned char)(headerPKT[LENGTH_HEADER_PKT-1])))
                {
                        //I have found 16 bytes that are a Pamela Packet Header                 
                        // I will pass it to state R4 and there I will add data to the Packet
                        R4_HEADER_State::getInstance().initBufferPKT(headerPKT);
                        StateManager::getInstance().changeState(&R4_HEADER_State::getInstance());                       
                        //just to be sure that always is clean
                        initHeaderPKT();
                }
                else
                {       
                        stringstream oss;
                        oss.str()="Packet Header skipped: ";
                        if (headerPKT[3]!=headerPKT[4])
                        {
                                oss<<"Packet Type mismatch ";                   
                        }
                        else
                        {
                                oss<<"Packet Header CRC check failed ";                         
                        }
                                
                        oss<<"The packet header starts at byte: "<<wherePKT_start<<" in cadre "<<iNumCadres<<" restart the search";                     
                        string msg = oss.str();
                        mainLogUtil->logWarning(msg);
        
                        //the 16 bytes analized cannot be considered a correct Header for a Pamela Packet.
                        //I want to check if in this 16 bytes I can find a new candidate for a Pam Pkt Header, i.e. a new set of FA FE DE.
                        //to do this I go back to the R0 state, and start look for 0xFA                         
                        resetHeaderPKT();//here I don't clean the buffer with the header
                        //change to state R0, it means searching 0xFA
                        StateManager::getInstance().changeState(&R0_Init_State::getInstance());
                        for(int i=3;i<LENGTH_HEADER_PKT;i++)
                        {       
                                //I am searching for byte 0xFA, if found I will check if it is the beginning of a new header    
                                        StateManager::getInstance().getCurrentState()->readInput(headerPKT[i]);         
                                }                                                       
                        }                       
                }                       
        }
        
}
1	//where I am
2	#include "R3_FAFEDE_State.h"
3	//manager
4	#include "StateManager.h"
5	//home
6	#include "R0_Init_State.h"
7	//a step after
8	#include "R4_HEADER_State.h"
9
10	//to compute CRC
11	#include "CRC.h"
12
13	//to log something
14	//#include "Logger.h"
15
16	namespace PamOffLineSW
17	{
18	extern LogUtil* mainLogUtil;
19	extern long int iNumCadres; //cadre's number
20	extern unsigned long long int iByte_tot;// how many bytes I have read till now
21
22	R3_FAFEDE_State R3_FAFEDE_State::instance;
23	int R3_FAFEDE_State::posHeaderPKT=2;
24
25	R3_FAFEDE_State::R3_FAFEDE_State()
26	{
27	initHeaderPKT();
28	}
29
30	R3_FAFEDE_State::~R3_FAFEDE_State()
31	{
32	}
33
34	void R3_FAFEDE_State::initHeaderPKT()
35	{
36	for(int j=0; j<LENGTH_HEADER_PKT; j++)
37	{
38	headerPKT[j]=0;
39	}
40	headerPKT[0]=CODE_FA;
41	headerPKT[1]=CODE_FE;
42	headerPKT[2]=CODE_DE;
43
44	posHeaderPKT=2;
45	}
46
47	void R3_FAFEDE_State::resetHeaderPKT()
48	{
49	posHeaderPKT=2;
50	}
51
52	void R3_FAFEDE_State::readInput(char inputbyte)
53	{
54	//the three bytes before this one are 0xFA 0xFE 0xDE, we want to check if it is a Pamela Packet
55	//to do this we read 16 bytes starting from 0xFA and compute the CRC
56	posHeaderPKT++;
57	headerPKT[posHeaderPKT]=inputbyte;
58
59	//if we have read all the header
60	if(posHeaderPKT==(LENGTH_HEADER_PKT-1))
61	{
62	//TODO: maybe if ex_pkt_type_1 != ex_pkt_type_2 the pkt is not good? maybe it shuold be discarded?
63	// put this check here and if the pkt must can't be recognised
64
65	//here we check the CRC
66	short int CalcCheckSum=(short int)(unsigned char)CM_Compute_CRC16(0, (unsigned char*)&headerPKT, LENGTH_HEADER_PKT-1);
67
68	//bytes when the PKT starts
69	unsigned long long int wherePKT_start=iByte_tot-posHeaderPKT+1;
70
71	//I check also that pkt_type is correct? headerPKT[3]=header[4] ??
72	if ((headerPKT[3]==headerPKT[4])&&(CalcCheckSum==(short int)(unsigned char)(headerPKT[LENGTH_HEADER_PKT-1])))
73	{
74	//I have found 16 bytes that are a Pamela Packet Header
75	// I will pass it to state R4 and there I will add data to the Packet
76	R4_HEADER_State::getInstance().initBufferPKT(headerPKT);
77	StateManager::getInstance().changeState(&R4_HEADER_State::getInstance());
78	//just to be sure that always is clean
79	initHeaderPKT();
80	}
81	else
82	{
83	stringstream oss;
84	oss.str()="Packet Header skipped: ";
85	if (headerPKT[3]!=headerPKT[4])
86	{
87	oss<<"Packet Type mismatch ";
88	}
89	else
90	{
91	oss<<"Packet Header CRC check failed ";
92	}
93
94	oss<<"The packet header starts at byte: "<<wherePKT_start<<" in cadre "<<iNumCadres<<" restart the search";
95	string msg = oss.str();
96	mainLogUtil->logWarning(msg);
97
98	//the 16 bytes analized cannot be considered a correct Header for a Pamela Packet.
99	//I want to check if in this 16 bytes I can find a new candidate for a Pam Pkt Header, i.e. a new set of FA FE DE.
100	//to do this I go back to the R0 state, and start look for 0xFA
101	resetHeaderPKT();//here I don't clean the buffer with the header
102	//change to state R0, it means searching 0xFA
103	StateManager::getInstance().changeState(&R0_Init_State::getInstance());
104	for(int i=3;i<LENGTH_HEADER_PKT;i++)
105	{
106	//I am searching for byte 0xFA, if found I will check if it is the beginning of a new header
107	StateManager::getInstance().getCurrentState()->readInput(headerPKT[i]);
108	}
109	}
110	}
111	}
112
113	}