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 2.5 2004/12/20 14:15:13 kusanagi Exp $ |
* $Id: TmtcReader.cpp,v 6.2 2006/05/30 19:10:02 kusanagi Exp $ |
4 |
* $Author: kusanagi $ |
* $Author: kusanagi $ |
5 |
* |
* |
6 |
* Implementation of the TmtcReader class. |
* Implementation of the TmtcReader class. |
8 |
* Control the CRC for the entire data Packet not just for single records |
* Control the CRC for the entire data Packet not just for single records |
9 |
*/ |
*/ |
10 |
|
|
|
#include <string> |
|
|
#include <log4cxx/logger.h> |
|
11 |
extern "C" { |
extern "C" { |
12 |
#include <sys/time.h> |
#include "CRC.h" |
|
#include "CRC.h" |
|
13 |
} |
} |
|
|
|
|
#include <fstream> |
|
|
#include "stdio.h" |
|
14 |
#include "ReaderAlgorithms.h" |
#include "ReaderAlgorithms.h" |
|
|
|
|
#include "event/tmtc/TmtcRecord.h" |
|
|
|
|
|
using namespace pamela; |
|
15 |
using namespace pamela::techmodel; |
using namespace pamela::techmodel; |
16 |
|
|
17 |
static log4cxx::LoggerPtr logger = log4cxx::Logger::getLogger(_T("pamela.techmodel.TmtcReader")); |
static log4cxx::LoggerPtr logger = log4cxx::Logger::getLogger(_T("pamela.techmodel.TmtcReader")); |
30 |
*/ |
*/ |
31 |
std::string TmtcReader::GetVersionInfo(void) const { |
std::string TmtcReader::GetVersionInfo(void) const { |
32 |
return |
return |
33 |
"$Header: /home/cvsmanager/yoda/techmodel/TmtcReader.cpp,v 2.5 2004/12/20 14:15:13 kusanagi Exp $\n"; |
"$Header: /home/cvsmanager/yoda/techmodel/TmtcReader.cpp,v 6.2 2006/05/30 19:10:02 kusanagi Exp $\n"; |
34 |
} |
} |
35 |
|
|
36 |
/** |
/** |
47 |
*/ |
*/ |
48 |
void TmtcReader::RunEvent(int EventNumber, long int length) throw (WrongCRCException){ |
void TmtcReader::RunEvent(int EventNumber, long int length) throw (WrongCRCException){ |
49 |
|
|
50 |
int i, j; |
int i, j, k; |
51 |
|
/* The ' k ' indexs the number of recs. |
52 |
|
* 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 '. |
53 |
|
*/ |
54 |
|
k = 0; |
55 |
char subData[TMTC_SUB_LENGTH]; |
char subData[TMTC_SUB_LENGTH]; |
56 |
char CRCbuff[TMTC_SUBCRC_LENGTH]; |
char CRCbuff[TMTC_SUBCRC_LENGTH]; |
57 |
char eventCRC[TMTC_CRC_LENGTH]; |
char eventCRC[TMTC_CRC_LENGTH]; |
64 |
|
|
65 |
UINT16 partialCRC = 0; //partial CRC updated as mcmd packet is read (to compare with the last two bytes of this event) |
UINT16 partialCRC = 0; //partial CRC updated as mcmd packet is read (to compare with the last two bytes of this event) |
66 |
UINT16 readCRC = 0; //partial CRC updated as mcmd packet is read (to compare with the last two bytes of this event) |
UINT16 readCRC = 0; //partial CRC updated as mcmd packet is read (to compare with the last two bytes of this event) |
|
|
|
67 |
for(int i = 0; i < numRecords; i++) { |
for(int i = 0; i < numRecords; i++) { |
68 |
start = InputFile->tellg(); |
start = InputFile->tellg(); |
69 |
InputFile->read(subData, sizeof(subData)); |
InputFile->read(subData, sizeof(subData)); |
74 |
|
|
75 |
//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 |
76 |
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]){ |
77 |
rec = new(recs[i]) TmtcRecord(); //add a new TmtcRecord |
rec = new(recs[k++]) TmtcRecord(); //add a new TmtcRecord |
78 |
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); |
79 |
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); |
80 |
for(int j = 0; j < 12; j++) { |
|
81 |
rec->TM_TH_ANA[j] = ((((UINT16)subData[6+j]<<8)&0xFF00) + (((UINT16)subData[7+j])&0x00FF)); //20 is the size of TM_DEA_ANA(16) + OBT(4) |
for(int j = 0; j < 16; j++) { |
82 |
|
rec->TM_TH_ANA[j] = ((((UINT16)subData[6 + 2*j]<<8)&0xFF00) + (((UINT16)subData[7 + 2*j])&0x00FF)); //20 is the size of TM_DEA_ANA(16) + OBT(4) |
83 |
} |
} |
84 |
|
|
85 |
for(int j = 0; j < 6; j++) { |
for(int j = 0; j < 6; j++) { |
86 |
rec->TM_DEA_ANA[j] = subData[30+j]; |
rec->TM_DEA_ANA[j] = subData[38+j]; |
87 |
} |
} |
88 |
|
|
89 |
} else { |
} else { |