1 |
/** @file |
/** @file |
2 |
* $Source: /home/cvsmanager/yoda/techmodel/TmtcReader.cpp,v $ |
* $Source: /home/cvsmanager/yoda/techmodel/TmtcReader.cpp,v $ |
3 |
* $Id: TmtcReader.cpp,v 4.2 2005/05/16 15:36:33 kusanagi Exp $ |
* $Id: TmtcReader.cpp,v 6.0 2006/02/07 17:11:10 kusanagi Exp $ |
4 |
* $Author: kusanagi $ |
* $Author: kusanagi $ |
5 |
* |
* |
6 |
* Implementation of the TmtcReader class. |
* Implementation of the TmtcReader class. |
40 |
*/ |
*/ |
41 |
std::string TmtcReader::GetVersionInfo(void) const { |
std::string TmtcReader::GetVersionInfo(void) const { |
42 |
return |
return |
43 |
"$Header: /home/cvsmanager/yoda/techmodel/TmtcReader.cpp,v 4.2 2005/05/16 15:36:33 kusanagi Exp $\n"; |
"$Header: /home/cvsmanager/yoda/techmodel/TmtcReader.cpp,v 6.0 2006/02/07 17:11:10 kusanagi Exp $\n"; |
44 |
} |
} |
45 |
|
|
46 |
/** |
/** |
57 |
*/ |
*/ |
58 |
void TmtcReader::RunEvent(int EventNumber, long int length) throw (WrongCRCException){ |
void TmtcReader::RunEvent(int EventNumber, long int length) throw (WrongCRCException){ |
59 |
|
|
60 |
int i, j; |
int i, j, k; |
61 |
|
/* The ' k ' indexs the number of recs. |
62 |
|
* It is needed to be indipendent from ' i ' because in case of CRC error the single record is skipped and ' i ' increase by one, but correct records to be stored are still ' i '. |
63 |
|
*/ |
64 |
|
k = 0; |
65 |
char subData[TMTC_SUB_LENGTH]; |
char subData[TMTC_SUB_LENGTH]; |
66 |
char CRCbuff[TMTC_SUBCRC_LENGTH]; |
char CRCbuff[TMTC_SUBCRC_LENGTH]; |
67 |
char eventCRC[TMTC_CRC_LENGTH]; |
char eventCRC[TMTC_CRC_LENGTH]; |
84 |
|
|
85 |
//This == CRCBuff is not really parametric take care if have to change the static lengths |
//This == CRCBuff is not really parametric take care if have to change the static lengths |
86 |
if((UINT8)(CM_Compute_CRC16(0, (UINT8*)&subData, TMTC_SUB_LENGTH)) == (UINT8)CRCbuff[0]){ |
if((UINT8)(CM_Compute_CRC16(0, (UINT8*)&subData, TMTC_SUB_LENGTH)) == (UINT8)CRCbuff[0]){ |
87 |
rec = new(recs[i]) TmtcRecord(); //add a new TmtcRecord |
rec = new(recs[k++]) TmtcRecord(); //add a new TmtcRecord |
88 |
rec->TM_RECORD_OBT = (((UINT32)subData[0]<<24)&0xFF000000) + (((UINT32)subData[1]<<16)&0x00FF0000) + (((UINT32)subData[2]<<8)&0x0000FF00) + (((UINT32)subData[3])&0x000000FF); |
rec->TM_RECORD_OBT = (((UINT32)subData[0]<<24)&0xFF000000) + (((UINT32)subData[1]<<16)&0x00FF0000) + (((UINT32)subData[2]<<8)&0x0000FF00) + (((UINT32)subData[3])&0x000000FF); |
89 |
rec->TM_DIAG_AND_BILEVEL_ACQ = (((UINT16)subData[4]<<8)&0x0000FF00) + (((UINT16)subData[5])&0x000000FF); |
rec->TM_DIAG_AND_BILEVEL_ACQ = (((UINT16)subData[4]<<8)&0x0000FF00) + (((UINT16)subData[5])&0x000000FF); |
90 |
|
|
93 |
} |
} |
94 |
|
|
95 |
for(int j = 0; j < 6; j++) { |
for(int j = 0; j < 6; j++) { |
96 |
rec->TM_DEA_ANA[j] = subData[36+j]; |
rec->TM_DEA_ANA[j] = subData[38+j]; |
97 |
} |
} |
98 |
|
|
99 |
} else { |
} else { |