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

Annotation of /yoda/techmodel/EventReader.cpp

Parent Directory Parent Directory | Revision Log Revision Log


Revision 6.10 - (hide annotations) (download)
Mon Nov 13 11:45:49 2006 UTC (18 years ago) by mocchiut
Branch: MAIN
CVS Tags: YODA6_3/17
Changes since 6.9: +28 -4 lines
Skip CPU padding when looking for next fafede

1 kusanagi 1.1 /** @file
2 mocchiut 6.10 * $Author: mocchiut $
3     * $Date: 2006/09/29 10:19:22 $
4     * $Revision: 6.9 $
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 pam-rm2 6.8 TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Calib2_Ac2, 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 mocchiut 6.10 "$Header: /afs/ba.infn.it/user/pamela/src/CVS/yoda/techmodel/EventReader.cpp,v 6.9 2006/09/29 10:19:22 mocchiut 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 1.10 while (!InputFile->eof() && ((step++ < maxPackets) || (maxPackets == 0))){
124 kusanagi 1.1 try {
125 pam-rm2 6.8 if (FindStart()) {
126     UnpackPscuHeader();
127 kusanagi 2.5 type = Header->GetPscuHeader()->GetPacketType();
128 kusanagi 1.1 AlgorithmMap::iterator i = TechmodelAlgorithmMap.find(type);
129     if (i != TechmodelAlgorithmMap.end()) {
130 kusanagi 2.5 TechmodelAlgorithm *EventAlgorithm(i->second);
131 kusanagi 1.1 EventAlgorithm->RunEvent(EventNumber, Header->GetPscuHeader()->GetPacketLenght());
132     Run->FillTrees(type);
133     Header->GetCounter()->Increment(type);
134 kusanagi 2.4 logger->info(Header->GetPscuHeader()->Print());
135 kusanagi 1.1 } else {
136 kusanagi 2.8 oss.str("");
137     oss << "\n No way to read events of type " << type->GetName().c_str() << Header->GetPscuHeader()->Print();
138     throw NotExistingAlgorithmException(oss.str().c_str()); //to exctract to an higher level and delete the logger!
139 kusanagi 2.3 }
140 mocchiut 6.10
141     //
142     // E. Mocchiutti
143     //
144    
145     //
146     // Start reading the next event jumping the CPU padding to 64 bits
147     //
148     Float_t pd0 = (16.+Header->GetPscuHeader()->GetPacketLenght())/64.;
149     Float_t pd1 = pd0 - (Float_t)int(pd0);
150     Float_t padfrac = 64. - pd1 * 64.;
151     //
152     UInt_t padbytes = (UInt_t)padfrac;
153     if ( padbytes > 0 ){
154     oss.str("");
155     oss << " padbytes is " << padbytes << " \n skipping these bytes\n";
156     logger->info(oss.str().c_str());
157     InputFile->seekg(padbytes,std::ios::cur);
158     };
159    
160     //
161     // end E. Mocchiutti
162     //
163    
164 kusanagi 2.3 }
165 kusanagi 2.4 // In case of exception have to save the packet in a specific root file??
166     } catch (NotExistingAlgorithmException exc) {
167 kusanagi 2.5 oss.str("");
168     oss << exc.print() << " " << Header->GetPscuHeader()->Print();
169     logger->error(oss.str().c_str());
170 kusanagi 2.4 } catch (WrongCRCHeaderException exc) {
171 kusanagi 2.5 oss.str("");
172 kusanagi 2.8 oss << exc.print();
173 kusanagi 2.5 logger->error(oss.str().c_str());
174 kusanagi 2.4 } catch (WrongCRCException exc) {
175 kusanagi 2.5 oss.str("");
176     oss << exc.print() << " " << Header->GetPscuHeader()->Print();
177     logger->error(oss.str().c_str());
178 kusanagi 6.6 archiveCorruptedPacket(Header->GetPscuHeader()->FileOffset, Header->GetPscuHeader()->PacketLenght);
179 pam-rm2 6.8
180 kusanagi 2.4 } catch (UnidentifiedPacketException exc) {
181 kusanagi 2.5 oss.str("");
182     oss << exc.print() << " " << Header->GetPscuHeader()->Print();
183     logger->error(oss.str().c_str());
184 kusanagi 2.4 } catch (NotExistingCounterException exc) {
185 kusanagi 2.5 oss.str("");
186     oss << exc.print() << " " << Header->GetPscuHeader()->Print();
187     logger->error(oss.str().c_str());
188 kusanagi 2.4 } catch (LengthException exc) {
189 kusanagi 2.5 oss.str("");
190     oss << exc.print() << " " << Header->GetPscuHeader()->Print();
191     logger->error(oss.str().c_str());
192 kusanagi 4.5 } catch (BackwardCounterException exc) {
193     oss.str("");
194     oss << exc.print() << " " << Header->GetPscuHeader()->Print();
195     logger->error(oss.str().c_str());
196 kusanagi 1.1 } catch (...) {
197 kusanagi 2.4 logger->error("Couldn't read the event. Skipping to the next header. \n");
198 kusanagi 1.1 }
199 kusanagi 2.1 if ((step%1000) == 0) std::cout << step/1000 << "K \n";
200 kusanagi 2.10 oss.str("");
201     oss << "----endPck " << Header->GetPscuHeader()->GetCounter() << "\n";
202     logger->info(oss.str().c_str());
203 kusanagi 1.1 }
204 kusanagi 1.10 Header->GetCounter()->PrintCounters();
205 kusanagi 6.3 //if (corruptedPacketFile.is_open()) corruptedPacketFile.close();
206 kusanagi 1.1 }
207    
208     /**
209     * Unpack the PSCU header from a file into the structure.
210     */
211 pam-rm2 6.8 void EventReader::UnpackPscuHeader(void) throw (WrongCRCHeaderException, LengthException, BackwardCounterException) {
212 kusanagi 1.10 stringstream oss;
213 kusanagi 4.5 int response = 0;
214 pam-rm2 6.8 char buff[16];
215 mocchiut 6.9 memset(buff, 0, 16*sizeof(char));
216 pam-rm2 6.8 InputFile->read(buff, sizeof(buff));
217    
218    
219     unsigned char PacketId1 = buff[3];
220     unsigned char PacketId2 = buff[4];
221     unsigned int Counter = (((UINT32)buff[5]<<16)&0x00FF0000) + (((UINT32)buff[6]<<8)&0x0000FF00) + (((UINT32)buff[7])&0x000000FF);
222     unsigned int OrbitalTime = (((UINT32)buff[8]<<24)&0xFF000000) + (((UINT32)buff[9]<<16)&0x00FF0000) + (((UINT32)buff[10]<<8)&0x0000FF00) + (((UINT32)buff[11])&0x000000FF);
223     unsigned int PacketLenght = (((UINT32)buff[12]<<16)&0x00FF0000) + (((UINT32)buff[13]<<8)&0x0000FF00) + (((UINT32)buff[14])&0x000000FF);
224     unsigned char CRC = buff[15];
225     unsigned char FileOffset = buff[15];
226    
227 kusanagi 4.5
228 pam-rm2 6.8 if (Counter < prevPckCounter){
229 kusanagi 4.5 response = prevPckCounter - Counter;
230     //oss.str("");
231     //oss << "Packet counter is less than before of " << (prevPckCounter - Counter);
232     //throw BackwardCounterException(oss.str().c_str());
233     //logger->error(oss.str().c_str());
234 kusanagi 2.10 }
235    
236 pam-rm2 6.8 if (Counter > prevPckCounter + 1){
237 kusanagi 2.10 oss.str("");
238     oss << "Packet counter is greater than before of " << (Counter - prevPckCounter);
239     logger->error(oss.str().c_str());
240 kusanagi 1.1 }
241 kusanagi 3.1
242 pam-rm2 6.8 if ((OrbitalTime == prevPckOBT) & (PacketId1 == 0x10)){
243 kusanagi 3.1 oss.str("");
244     oss << "Onboard Time of this packet is equal to the previous packet OBT";
245     logger->error(oss.str().c_str());
246     logger->error(Header->GetPscuHeader()->Print());
247     }
248 kusanagi 1.1
249 pam-rm2 6.8 if (OrbitalTime < prevPckOBT){
250 kusanagi 2.4 oss.str("");
251     oss << " Onboard Time is less than before of " << (prevPckOBT - OrbitalTime);
252 kusanagi 2.10 logger->error(oss.str().c_str());
253 kusanagi 1.1 }
254    
255 pam-rm2 6.8 if (((BYTE)CM_Compute_CRC16(0, (BYTE*)&buff, 15) == (BYTE)buff[15]) && (PacketId1 == PacketId2)){
256 kusanagi 1.7 prevPckCounter = Counter;
257     prevPckOBT = OrbitalTime;
258 pam-rm2 6.8 long int initPos = InputFile->tellg();
259 kusanagi 1.1 long int finalPos;
260     Header->GetPscuHeader()->SetPacketId(PacketId1, PacketId2);
261     Header->GetPscuHeader()->SetCounter(Counter);
262     Header->GetPscuHeader()->SetOrbitalTime(OrbitalTime);
263     //PacketLength is the length of the whole DATApacket starting from the first byte after the header
264     //plus the CRC legth (which varies for each type of packet)
265     Header->GetPscuHeader()->SetPacketLenght(PacketLenght);
266     Header->GetPscuHeader()->SetCRC(CRC);
267 kusanagi 1.9 Header->GetPscuHeader()->SetFileOffset(((long int)(InputFile->tellg()) - 16));
268 kusanagi 1.1 } else {
269 pam-rm2 6.8 /*Here i should extract the block of Data for later analysis */
270 kusanagi 1.8 InputFile->seekg(-(13), std::ios::cur);
271 kusanagi 2.8 oss.str("");
272 pam-rm2 6.8 oss << "CRC Header Error on packet:" << PscuHeader::Print(buff);
273 kusanagi 2.8 throw WrongCRCHeaderException(oss.str().c_str());
274 kusanagi 1.1 }
275 kusanagi 2.4
276 kusanagi 4.5 if (response > 0){
277     oss.str("");
278     oss << "Packet counter is less than before of " << response;
279     throw BackwardCounterException(oss.str().c_str());
280     }
281 kusanagi 1.1 }
282    
283     /**
284     * Unpack the trailer of a PSCU event into the structure.
285     */
286     void EventReader::UnpackPscuTrailer(void) throw (std::exception) {
287    
288     }
289    
290     /**
291     * Find the next starting poin for the PSCU event looking for a {0xFA, 0xFE, 0xDE} sequence
292     */
293 pam-rm2 6.8 bool EventReader::FindStart(void) throw (std::exception) {
294 kusanagi 1.1 //search an hexadecimal sequence in a file
295     //subSign ------> pointer to the sequence buffer
296     //subSignDim ------> dimension of the buffer
297     // at exit
298     // return true if founds a match (else false)
299     // subF point rigth after the match, if found. Else EOF.
300     //Maurizio 15/11/2002-----------------------
301 kusanagi 2.4 const int subSignDim = 3;
302     const unsigned char subSign[subSignDim]={0xFA, 0xFE, 0xDE};
303 kusanagi 1.1 //------------------------------------------
304     int subIndex = 0;
305     char dataByte;
306 kusanagi 4.1
307     int buffSize = 64;
308 kusanagi 1.10 int index = 0;
309 pam-rm2 6.8 int loop = -1;
310 kusanagi 1.10 char buffer[buffSize];
311 kusanagi 4.1 bool flagOverPad = false;
312 mocchiut 6.9 memset(buffer, 0, buffSize*sizeof(char));
313 kusanagi 1.10 while (!InputFile->eof()) {
314 pam-rm2 6.8 InputFile->read(buffer, sizeof(buffer));
315 kusanagi 1.10 index = 0;
316 pam-rm2 6.8 loop++;
317     while (index < buffSize){
318     dataByte = buffer[index++];
319     if (dataByte == (char)(*(subSign+subIndex))){
320     if (subIndex++ == (subSignDim-1)) {
321     InputFile->seekg( (index - (subIndex + buffSize)), std::ios::cur);
322     if (flagOverPad){
323     oss.str("");
324     oss << "\n This packet beginning is farther than 64 byte from the end of the previous."
325     << "\n Below the is the last already unpacked packet";
326     logger->error(oss.str().c_str());
327     logger->error(Header->GetPscuHeader()->Print());
328     }
329     return true;
330     }
331     } else {
332     index = index - (subIndex);
333     subIndex = 0;
334 kusanagi 1.10 }
335     }
336 kusanagi 2.4 //Needs to guarantee the overap of the buffer(s) in several loop
337 kusanagi 4.1 flagOverPad = true;
338 pam-rm2 6.8 InputFile->seekg( (-1)*(subSignDim + 1) , std::ios::cur);
339 kusanagi 2.7 }
340     return false;
341 kusanagi 1.1 }
342    
343 pam-rm2 6.8
344     int EventReader::archiveCorruptedPacket(long int offset, long int length) {
345     if (!corruptedPacketFile.is_open()) {
346     oss.str("");
347     oss << Run->GetUnpackPath().c_str() << "Corrupted.dat";
348     cout << oss.str().c_str() << "\n";
349     cout << dec << offset << "\n";
350     cout << dec << length << "\n";
351     corruptedPacketFile.open(oss.str().c_str(), ios::out);
352     }
353     char *buffer = new char[length];
354     InputFile->seekg(offset, ios_base::beg );
355     InputFile->read(buffer, length);
356     corruptedPacketFile.write(buffer, length);
357     InputFile->seekg(offset + 1, ios_base::beg );
358     }
359    
360 kusanagi 1.1 ClassImp(EventReader)

  ViewVC Help
Powered by ViewVC 1.1.23