/[PAMELA software]/yoda/techmodel/EventReader.cpp
ViewVC logotype

Annotation of /yoda/techmodel/EventReader.cpp

Parent Directory Parent Directory | Revision Log Revision Log


Revision 6.7 - (hide annotations) (download)
Wed Aug 16 13:15:23 2006 UTC (18 years, 3 months ago) by kusanagi
Branch: MAIN
CVS Tags: YODA6_3/06
Changes since 6.6: +63 -67 lines
*** empty log message ***

1 kusanagi 1.1 /** @file
2 kusanagi 6.0 * $Author: kusanagi $
3 kusanagi 6.7 * $Date: 2006/05/30 19:58:25 $
4     * $Revision: 6.6 $
5 kusanagi 1.1 *
6     * Implementation of the functions of a sample Algorithm class.
7     * This file can be used as a templace to develop your own algorithm.
8     */
9    
10 kusanagi 1.10 #include <log4cxx/logger.h>
11 kusanagi 1.1 #include "EventReader.h"
12     #include "ReaderAlgorithms.h"
13 kusanagi 2.4
14 kusanagi 1.1 extern "C" {
15 kusanagi 2.4 #include "CRC.h"
16 kusanagi 1.1 }
17    
18     using namespace pamela;
19     using namespace pamela::techmodel;
20    
21 kusanagi 1.10 static log4cxx::LoggerPtr logger = log4cxx::Logger::getLogger(_T("pamela.techmodel.EventReader"));
22    
23     unsigned int EventReader::maxPackets = 0;
24 kusanagi 1.7 unsigned int EventReader::prevPckCounter = 0;
25     unsigned int EventReader::prevPckOBT = 0;
26 kusanagi 1.10
27    
28 kusanagi 1.1 /**
29     * Constructor.
30     */
31 kusanagi 1.10 EventReader::EventReader(int packetsLimit = -1):
32     TechmodelAlgorithm(0, "TechmodelEventReader"){
33     EventReader::maxPackets = packetsLimit;
34     logger->debug(_T("Constructor"));
35 kusanagi 1.1 Header = new EventHeader();
36 kusanagi 1.5
37 kusanagi 2.5 TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::PhysEndRun, new PhysEndRunReader));
38     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibCalPulse1, new CalibCalPulse1Reader));
39     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibCalPulse2, new CalibCalPulse2Reader));
40     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Physics, new PhysicsReader));
41 kusanagi 6.4 TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTrkBoth, new CalibTrkBothReader));
42 kusanagi 2.5 TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTrk1, new CalibTrk1Reader));
43     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTrk2, new CalibTrk2Reader));
44     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTof, new CalibTofReader));
45     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibS4, new CalibS4Reader));
46     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibCalPed, new CalibCalPedReader));
47 kusanagi 2.6 TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Calib1_Ac1, new Calib1_Ac1Reader));
48     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Calib2_Ac1, new Calib2_Ac1Reader));
49     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Calib1_Ac2, new Calib1_Ac2Reader));
50     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Calib2_Ac2, new Calib2_Ac2Reader));
51 kusanagi 6.7 TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibCal, new CalibCalReader));
52 kusanagi 2.5 TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::RunHeader, new RunHeaderReader));
53     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::RunTrailer, new RunTrailerReader));
54     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibHeader, new CalibHeaderReader));
55     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTrailer, new CalibTrailerReader));
56     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::InitHeader, new InitHeaderReader));
57     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::InitTrailer, new InitTrailerReader));
58 kusanagi 6.1 TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::EventTrk, new EventTrkReader));
59 kusanagi 2.5 TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Log, new LogReader));
60     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::VarDump, new VarDumpReader));
61     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::ArrDump, new ArrDumpReader));
62     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TabDump, new TabDumpReader));
63     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Tmtc, new TmtcReader));
64     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Mcmd, new McmdReader));
65     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::ForcedFECmd, new ForcedFECmdReader));
66 kusanagi 2.6 TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Ac1Init, new Ac1InitReader));
67 kusanagi 2.5 TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalInit, new CalInitReader));
68     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TrkInit, new TrkInitReader));
69     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TofInit, new TofInitReader));
70     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TrgInit, new TrgInitReader));
71     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::NdInit, new NdInitReader));
72     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::S4Init, new S4InitReader));
73 kusanagi 2.6 TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Ac2Init, new Ac2InitReader));
74 kusanagi 2.5 TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalAlarm, new CalAlarmReader));
75 kusanagi 6.4 TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Ac1Alarm, new Ac1AlarmReader));
76 kusanagi 2.5 TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TrkAlarm, new TrkAlarmReader));
77     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TrgAlarm, new TrgAlarmReader));
78     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TofAlarm, new TofAlarmReader));
79     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::S4Alarm, new S4AlarmReader));
80 kusanagi 6.4 TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Ac2Alarm, new Ac2AlarmReader));
81 kusanagi 2.11 TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TsbT, new TsbTReader));
82     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TsbB, new TsbBReader));
83 kusanagi 1.1 }
84    
85     /**
86     * Get a string with the version info of the algorithm.
87     */
88     std::string EventReader::GetVersionInfo(void) const {
89     return
90 kusanagi 6.7 "$Header: /home/cvsmanager/yoda/techmodel/EventReader.cpp,v 6.6 2006/05/30 19:58:25 kusanagi Exp $\n";
91 kusanagi 1.1 }
92    
93     /**
94     * Initialize the algorithm with a special run. This will initialize the
95     * event reader routines for all packet types.
96     */
97     void EventReader::Init(PamelaRun *run) {
98     SetInputStream(run);
99     //Create the structure of directories and create xxx.Header.root files
100     run->WriteHeaders(this, &Header);
101    
102     //Create the xxx.root in it's specific directory
103     for (AlgorithmMap::iterator i = TechmodelAlgorithmMap.begin();
104     i != TechmodelAlgorithmMap.end(); i++) {
105 kusanagi 2.4 oss.str("");
106 kusanagi 1.10 oss << "Initializing algo " << i->second->GetAlgorithmName();
107     logger->debug(oss.str().c_str());
108 kusanagi 1.1 i->second->Init(run);
109     }
110     Run = dynamic_cast<TechmodelPamelaRun*>(run);
111     }
112    
113     static void SkipToNextHeader(ifstream *);
114    
115     /**
116     * Read the next event header, call the reader algorithms that
117     * correspond to its packet type, and read the event trailer.
118     */
119     void EventReader::RunEvent(int EventNumber) {
120 kusanagi 1.10 stringstream oss;
121     int step = 0;
122 kusanagi 2.5 const PacketType* type;
123 kusanagi 6.7 unsigned char *header;
124 kusanagi 1.10 while (!InputFile->eof() && ((step++ < maxPackets) || (maxPackets == 0))){
125 kusanagi 1.1 try {
126 kusanagi 6.7 if (FindStart(*&header, 16)) {
127     UnpackPscuHeader(*&header);
128 kusanagi 2.5 type = Header->GetPscuHeader()->GetPacketType();
129 kusanagi 1.1 AlgorithmMap::iterator i = TechmodelAlgorithmMap.find(type);
130     if (i != TechmodelAlgorithmMap.end()) {
131 kusanagi 2.5 TechmodelAlgorithm *EventAlgorithm(i->second);
132 kusanagi 1.1 EventAlgorithm->RunEvent(EventNumber, Header->GetPscuHeader()->GetPacketLenght());
133     Run->FillTrees(type);
134     Header->GetCounter()->Increment(type);
135 kusanagi 2.4 logger->info(Header->GetPscuHeader()->Print());
136 kusanagi 1.1 } else {
137 kusanagi 2.8 oss.str("");
138     oss << "\n No way to read events of type " << type->GetName().c_str() << Header->GetPscuHeader()->Print();
139     throw NotExistingAlgorithmException(oss.str().c_str()); //to exctract to an higher level and delete the logger!
140 kusanagi 2.3 }
141     }
142 kusanagi 2.4 // In case of exception have to save the packet in a specific root file??
143     } catch (NotExistingAlgorithmException exc) {
144 kusanagi 2.5 oss.str("");
145     oss << exc.print() << " " << Header->GetPscuHeader()->Print();
146     logger->error(oss.str().c_str());
147 kusanagi 2.4 } catch (WrongCRCHeaderException exc) {
148 kusanagi 2.5 oss.str("");
149 kusanagi 2.8 oss << exc.print();
150 kusanagi 2.5 logger->error(oss.str().c_str());
151 kusanagi 2.4 } catch (WrongCRCException exc) {
152 kusanagi 2.5 oss.str("");
153     oss << exc.print() << " " << Header->GetPscuHeader()->Print();
154     logger->error(oss.str().c_str());
155 kusanagi 6.6 archiveCorruptedPacket(Header->GetPscuHeader()->FileOffset, Header->GetPscuHeader()->PacketLenght);
156 kusanagi 2.4 } catch (UnidentifiedPacketException exc) {
157 kusanagi 2.5 oss.str("");
158     oss << exc.print() << " " << Header->GetPscuHeader()->Print();
159     logger->error(oss.str().c_str());
160 kusanagi 2.4 } catch (NotExistingCounterException exc) {
161 kusanagi 2.5 oss.str("");
162     oss << exc.print() << " " << Header->GetPscuHeader()->Print();
163     logger->error(oss.str().c_str());
164 kusanagi 2.4 } catch (LengthException exc) {
165 kusanagi 2.5 oss.str("");
166     oss << exc.print() << " " << Header->GetPscuHeader()->Print();
167     logger->error(oss.str().c_str());
168 kusanagi 4.5 } catch (BackwardCounterException exc) {
169     oss.str("");
170     oss << exc.print() << " " << Header->GetPscuHeader()->Print();
171     logger->error(oss.str().c_str());
172 kusanagi 1.1 } catch (...) {
173 kusanagi 2.4 logger->error("Couldn't read the event. Skipping to the next header. \n");
174 kusanagi 1.1 }
175 kusanagi 2.1 if ((step%1000) == 0) std::cout << step/1000 << "K \n";
176 kusanagi 2.10 oss.str("");
177     oss << "----endPck " << Header->GetPscuHeader()->GetCounter() << "\n";
178     logger->info(oss.str().c_str());
179 kusanagi 1.1 }
180 kusanagi 1.10 Header->GetCounter()->PrintCounters();
181 kusanagi 6.3 //if (corruptedPacketFile.is_open()) corruptedPacketFile.close();
182 kusanagi 1.1 }
183    
184     /**
185     * Unpack the PSCU header from a file into the structure.
186     */
187 kusanagi 6.7 void EventReader::UnpackPscuHeader(unsigned char *header) throw (WrongCRCHeaderException, LengthException, BackwardCounterException) {
188     if (header == NULL) throw LengthException("errore di lunghezza");
189 kusanagi 1.10 stringstream oss;
190 kusanagi 4.5 int response = 0;
191    
192 kusanagi 6.7 unsigned char PacketId1 = header[3];
193     unsigned char PacketId2 = header[4];
194     unsigned int Counter = (((UINT32)header[5]<<16)&0x00FF0000) + (((UINT32)header[6]<<8)&0x0000FF00) + (((UINT32)header[7])&0x000000FF);
195     unsigned int OrbitalTime = (((UINT32)header[8]<<24)&0xFF000000) + (((UINT32)header[9]<<16)&0x00FF0000) + (((UINT32)header[10]<<8)&0x0000FF00) + (((UINT32)header[11])&0x000000FF);
196     unsigned int PacketLenght = (((UINT32)header[12]<<16)&0x00FF0000) + (((UINT32)header[13]<<8)&0x0000FF00) + (((UINT32)header[14])&0x000000FF);
197     unsigned char CRC = header[15];
198     unsigned char FileOffset = header[15];
199    
200     long int initPos = InputFile->tellg();
201     // Check parameters anomalies. If initPos < 16 it is the first packet
202     // (supposing a correct starting packet!)
203     if ((Counter < prevPckCounter) && (initPos > 16)){
204 kusanagi 4.5 response = prevPckCounter - Counter;
205     //oss.str("");
206     //oss << "Packet counter is less than before of " << (prevPckCounter - Counter);
207     //throw BackwardCounterException(oss.str().c_str());
208     //logger->error(oss.str().c_str());
209 kusanagi 2.10 }
210    
211 kusanagi 6.7 if ((Counter > prevPckCounter + 1) && (initPos > 16)){
212 kusanagi 2.10 oss.str("");
213     oss << "Packet counter is greater than before of " << (Counter - prevPckCounter);
214     logger->error(oss.str().c_str());
215 kusanagi 1.1 }
216 kusanagi 3.1
217 kusanagi 6.7 if ((OrbitalTime == prevPckOBT) && (PacketId1 == 0x10) && (initPos > 16)) {
218 kusanagi 3.1 oss.str("");
219     oss << "Onboard Time of this packet is equal to the previous packet OBT";
220     logger->error(oss.str().c_str());
221     logger->error(Header->GetPscuHeader()->Print());
222     }
223 kusanagi 1.1
224 kusanagi 6.7 if ((OrbitalTime < prevPckOBT) && (initPos > 16)) {
225 kusanagi 2.4 oss.str("");
226     oss << " Onboard Time is less than before of " << (prevPckOBT - OrbitalTime);
227 kusanagi 2.10 logger->error(oss.str().c_str());
228 kusanagi 1.1 }
229    
230 kusanagi 6.7 if ( ((BYTE)CM_Compute_CRC16(0, (BYTE*)header, 15) == (BYTE)header[15]) && (PacketId1 == PacketId2)){
231 kusanagi 1.7 prevPckCounter = Counter;
232     prevPckOBT = OrbitalTime;
233 kusanagi 1.1 long int finalPos;
234     Header->GetPscuHeader()->SetPacketId(PacketId1, PacketId2);
235     Header->GetPscuHeader()->SetCounter(Counter);
236     Header->GetPscuHeader()->SetOrbitalTime(OrbitalTime);
237     //PacketLength is the length of the whole DATApacket starting from the first byte after the header
238     //plus the CRC legth (which varies for each type of packet)
239     Header->GetPscuHeader()->SetPacketLenght(PacketLenght);
240     Header->GetPscuHeader()->SetCRC(CRC);
241 kusanagi 1.9 Header->GetPscuHeader()->SetFileOffset(((long int)(InputFile->tellg()) - 16));
242 kusanagi 1.1 } else {
243 kusanagi 6.7 //Here i should extract the block of Data for later analysis
244 kusanagi 1.8 InputFile->seekg(-(13), std::ios::cur);
245 kusanagi 2.8 oss.str("");
246 kusanagi 6.7 oss << "CRC Header Error on packet:" << PscuHeader::Print((char*)header);
247 kusanagi 2.8 throw WrongCRCHeaderException(oss.str().c_str());
248 kusanagi 1.1 }
249 kusanagi 2.4
250 kusanagi 4.5 if (response > 0){
251     oss.str("");
252     oss << "Packet counter is less than before of " << response;
253     throw BackwardCounterException(oss.str().c_str());
254     }
255 kusanagi 1.1 }
256    
257 kusanagi 6.7
258 kusanagi 1.1 /**
259     * Unpack the trailer of a PSCU event into the structure.
260     */
261     void EventReader::UnpackPscuTrailer(void) throw (std::exception) {
262    
263     }
264    
265 kusanagi 6.7 int EventReader::archiveCorruptedPacket(long int offset, long int length) {
266     if (!corruptedPacketFile.is_open()) {
267     oss.str("");
268     oss << Run->GetUnpackPath().c_str() << "Corrupted.dat";
269     cout << oss.str().c_str() << "\n";
270     cout << dec << offset << "\n";
271     cout << dec << length << "\n";
272     corruptedPacketFile.open(oss.str().c_str(), ios::out);
273     }
274     char *buffer = new char[length];
275     InputFile->seekg(offset, ios_base::beg );
276     InputFile->read(buffer, length);
277     corruptedPacketFile.write(buffer, length);
278     InputFile->seekg(offset + 1, ios_base::beg );
279     }
280    
281 kusanagi 1.1 /**
282     * Find the next starting poin for the PSCU event looking for a {0xFA, 0xFE, 0xDE} sequence
283     */
284 kusanagi 6.7 bool EventReader::FindStart(unsigned char *header, long lenght) throw (std::exception) {
285 kusanagi 1.1 //search an hexadecimal sequence in a file
286     //subSign ------> pointer to the sequence buffer
287     //subSignDim ------> dimension of the buffer
288     // at exit
289     // return true if founds a match (else false)
290     // subF point rigth after the match, if found. Else EOF.
291     //Maurizio 15/11/2002-----------------------
292 kusanagi 2.4 const int subSignDim = 3;
293     const unsigned char subSign[subSignDim]={0xFA, 0xFE, 0xDE};
294 kusanagi 1.1 //------------------------------------------
295     int subIndex = 0;
296     char dataByte;
297 kusanagi 4.1
298     int buffSize = 64;
299 kusanagi 1.10 int index = 0;
300     char buffer[buffSize];
301 kusanagi 6.7 char *offset;
302 kusanagi 4.1 bool flagOverPad = false;
303 kusanagi 1.10
304     while (!InputFile->eof()) {
305 kusanagi 6.7 InputFile->read(buffer, buffSize);
306 kusanagi 1.10 index = 0;
307 kusanagi 6.7 offset = &buffer[0];
308     while (index < buffSize - 3){
309     if (!(memcmp(offset, subSign, 3))){
310     InputFile->seekg(index - buffSize + 16, std::ios::cur);
311     if (flagOverPad){
312     oss.str("");
313     oss << "\n This packet beginning is farther than 64 byte from the end of the previous."
314     << "\n Below the is the last already unpacked packet";
315     logger->error(oss.str().c_str());
316     logger->error(Header->GetPscuHeader()->Print());
317     }
318     memcpy(header, offset, lenght);
319     return true;
320 kusanagi 1.10 }
321 kusanagi 6.7 index++;
322     offset++;
323 kusanagi 1.10 }
324 kusanagi 2.4 //Needs to guarantee the overap of the buffer(s) in several loop
325 kusanagi 4.1 flagOverPad = true;
326 kusanagi 6.7 InputFile->seekg( -3 , std::ios::cur);
327 kusanagi 2.7 }
328     return false;
329 kusanagi 1.1 }
330    
331     ClassImp(EventReader)

  ViewVC Help
Powered by ViewVC 1.1.23