| 1 |
/** @file |
/** @file |
| 2 |
* $Source: /home/cvspamela/yoda/techmodel/TmtcReader.cpp,v $ |
* $Source: /home/cvsmanager/yoda/techmodel/TmtcReader.cpp,v $ |
| 3 |
* $Id: TmtcReader.cpp,v 1.8 2004/04/28 09:01:27 nagni Exp $ |
* $Id: TmtcReader.cpp,v 1.3 2004/08/24 16:01:57 kusanagi Exp $ |
| 4 |
* $Author: nagni $ |
* $Author: kusanagi $ |
| 5 |
* |
* |
| 6 |
* Implementation of the TmtcReader class. |
* Implementation of the TmtcReader class. |
| 7 |
* ToBeDone: |
* ToBeDone: |
| 12 |
|
|
| 13 |
|
|
| 14 |
#include <string> |
#include <string> |
| 15 |
#include <log4cpp/Category.hh> |
#include <log4cxx/logger.h> |
| 16 |
extern "C" { |
extern "C" { |
| 17 |
#include <sys/time.h> |
#include <sys/time.h> |
| 18 |
#include "CRC.h" |
#include "CRC.h" |
| 27 |
using namespace pamela; |
using namespace pamela; |
| 28 |
using namespace pamela::techmodel; |
using namespace pamela::techmodel; |
| 29 |
|
|
| 30 |
static log4cpp::Category& cat = log4cpp::Category::getInstance("pamela.techmodel.TmtcReader"); |
static log4cxx::LoggerPtr logger = log4cxx::Logger::getLogger(_T("pamela.techmodel.TmtcReader")); |
| 31 |
|
|
| 32 |
/** |
/** |
| 33 |
* Constructor. |
* Constructor. |
| 34 |
*/ |
*/ |
| 35 |
TmtcReader::TmtcReader(void): |
TmtcReader::TmtcReader(void): |
| 36 |
TechmodelAlgorithm(PacketType::Tmtc, "TechmodelTmtcReader") { |
TechmodelAlgorithm(PacketType::Tmtc, "TechmodelTmtcReader") { |
| 37 |
cat << log4cpp::Priority::DEBUG |
logger->debug(_T("Constructor")); |
|
<< "Constructor " |
|
|
<< "\n " << log4cpp::CategoryStream::ENDLINE; |
|
| 38 |
Tmtc = new TmtcEvent(); |
Tmtc = new TmtcEvent(); |
| 39 |
} |
} |
| 40 |
|
|
| 43 |
*/ |
*/ |
| 44 |
std::string TmtcReader::GetVersionInfo(void) const { |
std::string TmtcReader::GetVersionInfo(void) const { |
| 45 |
return |
return |
| 46 |
"$Header: /home/cvspamela/yoda/techmodel/TmtcReader.cpp,v 1.8 2004/04/28 09:01:27 nagni Exp $\n"; |
"$Header: /home/cvsmanager/yoda/techmodel/TmtcReader.cpp,v 1.3 2004/08/24 16:01:57 kusanagi Exp $\n"; |
| 47 |
} |
} |
| 48 |
|
|
| 49 |
/** |
/** |
| 72 |
*/ |
*/ |
| 73 |
|
|
| 74 |
int i, j; |
int i, j; |
| 75 |
char buff[TMTC_SUB_LENGTH]; |
char subData[TMTC_SUB_LENGTH]; |
| 76 |
char CRCbuff[TMTC_SUBCRC_LENGTH]; |
char CRCbuff[TMTC_SUBCRC_LENGTH]; |
| 77 |
char eventCRC[TMTC_CRC_LENGTH]; |
char eventCRC[TMTC_CRC_LENGTH]; |
| 78 |
int numRecords = (length-TMTC_CRC_LENGTH)/(TMTC_SUB_LENGTH + TMTC_SUBCRC_LENGTH); //subtract the last two bytes because are the final CRC |
int numRecords = (length-TMTC_CRC_LENGTH)/(TMTC_SUB_LENGTH + TMTC_SUBCRC_LENGTH); //subtract the last two bytes because are the final CRC |
| 79 |
long int start; |
long int start; |
| 80 |
|
|
| 81 |
|
TmtcRecord* rec; |
| 82 |
Tmtc->Records->Clear(); |
Tmtc->Records->Clear(); |
| 83 |
TClonesArray &recs = *(Tmtc->Records); |
TClonesArray &recs = *(Tmtc->Records); |
| 84 |
TmtcRecord* rec; |
|
| 85 |
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) |
| 86 |
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) |
|
int oldSize = recs.GetSize(); |
|
|
recs.ExpandCreate(oldSize+numRecords-1); |
|
| 87 |
|
|
| 88 |
|
/* char tempData[length-TMTC_CRC_LENGTH]; |
| 89 |
|
InputFile->read(tempData, sizeof(tempData)); |
| 90 |
|
partialCRC = CM_Compute_CRC16(0, (UINT8*)tempData, (length-TMTC_CRC_LENGTH)); |
| 91 |
|
*/ |
| 92 |
|
|
| 93 |
for(i = 0; i < numRecords; i++) { |
for(i = 0; i < numRecords; i++) { |
| 94 |
start = InputFile->tellg(); |
start = InputFile->tellg(); |
| 95 |
InputFile->read(buff, sizeof(buff)); |
InputFile->read(subData, sizeof(subData)); |
| 96 |
InputFile->read(CRCbuff, sizeof(CRCbuff)); |
InputFile->read(CRCbuff, sizeof(CRCbuff)); |
|
|
|
|
/*for (int jj = 0; jj < TMTC_SUB_LENGTH ; jj++){ |
|
|
partialCRC = CM_Compute_CRC8_8((char)partialCRC, (unsigned char*)buff[jj], 1); |
|
|
}*/ |
|
| 97 |
|
|
| 98 |
partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&buff, TMTC_SUB_LENGTH); |
/* for (int jj = 0; jj < TMTC_SUB_LENGTH ; jj++){ |
| 99 |
|
partialCRC = CM_Compute_CRC16(0, (UINT8*)tempData, (length-TMTC_CRC_LENGTH)); |
| 100 |
|
} |
| 101 |
|
*/ |
| 102 |
|
|
| 103 |
|
partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&subData, TMTC_SUB_LENGTH); |
| 104 |
partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&CRCbuff, TMTC_SUBCRC_LENGTH); |
partialCRC = CM_Compute_CRC16(partialCRC, (UINT8*)&CRCbuff, TMTC_SUBCRC_LENGTH); |
| 105 |
|
|
| 106 |
//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 |
| 107 |
if((UINT8)(CM_Compute_CRC16(0, (UINT8*)&buff, TMTC_SUB_LENGTH)) == (UINT8)CRCbuff[0]){ |
if((UINT8)(CM_Compute_CRC16(0, (UINT8*)&subData, TMTC_SUB_LENGTH)) == (UINT8)CRCbuff[0]){ |
| 108 |
rec = new TmtcRecord(); //add a new TmtcRecord |
rec = new(recs[i]) TmtcRecord(); //add a new TmtcRecord |
| 109 |
rec->TM_RECORD_OBT = (((UINT32)buff[0]<<24)&0xFF000000) + (((UINT32)buff[1]<<16)&0x00FF0000) + (((UINT32)buff[2]<<8)&0x0000FF00) + ((UINT32)buff[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; |
| 110 |
|
|
| 111 |
for(j = 0; j < 16; j++) { |
for(j = 0; j < 16; j++) { |
| 112 |
rec->TM_DEA_ANA[j] = (((UINT16)buff[4+j]<<8)&0xFF00) + (((UINT16)buff[5+j])&0x00FF); |
rec->TM_DEA_ANA[j] = (((UINT16)subData[4+j]<<8)&0xFF00) + (((UINT16)subData[5+j])&0x00FF); |
| 113 |
rec->TM_DEA_ANA_P[j] = (float)(rec->TM_DEA_ANA[j]*0.02); |
rec->TM_DEA_ANA_P[j] = (float)(rec->TM_DEA_ANA[j]*0.02); |
| 114 |
|
|
| 115 |
rec->TM_TH_ANA[j] = buff[36+j]; //36 is the size of TM_DEA_ANA + OBT |
rec->TM_TH_ANA[j] = subData[36+j]; //36 is the size of TM_DEA_ANA + OBT |
| 116 |
rec->TM_TH_ANA_P[j] = convert_th(rec->TM_TH_ANA[j]); |
rec->TM_TH_ANA_P[j] = convert_th(rec->TM_TH_ANA[j]); |
| 117 |
} |
} |
| 118 |
|
|
| 119 |
rec->TM_BIL_DIAG_ACQ = buff[53]; |
rec->TM_BIL_DIAG_ACQ = subData[53]; |
| 120 |
rec->TM_CC_DIAG_ACQ = (((UINT32)buff[54]<<24)&0xFF000000) + (((UINT32)buff[55]<<16)&0x00FF0000) + (((UINT32)buff[56]<<8)&0x0000FF00) + ((UINT32)buff[57])&0x000000FF; |
rec->TM_CC_DIAG_ACQ = (((UINT32)subData[54]<<24)&0xFF000000) + (((UINT32)subData[55]<<16)&0x00FF0000) + (((UINT32)subData[56]<<8)&0x0000FF00) + ((UINT32)subData[57])&0x000000FF; |
|
recs.AddAt(&(*rec), oldSize+i); |
|
| 121 |
} else { |
} else { |
| 122 |
cat << log4cpp::Priority::ERROR |
stringstream oss; |
| 123 |
<< "Wrong CRC on Subpacket int TMTC Packet starting at position " << start |
oss.flush(); |
| 124 |
<< "\n " << log4cpp::CategoryStream::ENDLINE; |
oss << "Wrong CRC on Subpacket int TMTC Packet starting at position" |
| 125 |
|
<< start; |
| 126 |
|
logger->warn(oss.str().c_str()); |
| 127 |
} |
} |
| 128 |
} |
} |
| 129 |
InputFile->read(eventCRC, sizeof(eventCRC)); |
InputFile->read(eventCRC, sizeof(eventCRC)); |
| 130 |
readCRC = (((UINT16)(eventCRC[0]<<8))&0xFF00) + (((UINT16)eventCRC[1])&0x00FF); |
readCRC = (((UINT16)(eventCRC[0]<<8))&0xFF00) + (((UINT16)eventCRC[1])&0x00FF); |
| 131 |
if(!(partialCRC == readCRC)) { |
if(!(partialCRC == readCRC)) { |
| 132 |
cat << log4cpp::Priority::ERROR |
logger->warn(_T("The test of calculated CRC with one wrote on file FAILED!!")); |
|
<< "The test of calculated CRC with one wrote on file FAILED!!" |
|
|
<< "\n " << log4cpp::CategoryStream::ENDLINE; |
|
| 133 |
} |
} |
| 134 |
} |
} |
| 135 |
|
|