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

Annotation of /yoda/techmodel/EventReader.cpp

Parent Directory Parent Directory | Revision Log Revision Log


Revision 2.5 - (hide annotations) (download)
Thu Dec 9 08:48:41 2004 UTC (19 years, 11 months ago) by kusanagi
Branch: MAIN
Changes since 2.4: +66 -64 lines
Fixed bug of Stack overflow in case of Log CRCError
Added S4Init & S4Alarm packets

1 kusanagi 1.1 /** @file
2 kusanagi 1.2 * $Author: kusanagi $
3 kusanagi 2.5 * $Date: 2004/12/03 22:08:00 $
4     * $Revision: 2.4 $
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 <fstream>
12     #include "EventReader.h"
13     #include "ReaderAlgorithms.h"
14 kusanagi 2.4
15    
16 kusanagi 1.1 extern "C" {
17 kusanagi 2.4 #include "CRC.h"
18 kusanagi 1.1 }
19    
20     using namespace pamela;
21     using namespace pamela::techmodel;
22    
23 kusanagi 1.10 static log4cxx::LoggerPtr logger = log4cxx::Logger::getLogger(_T("pamela.techmodel.EventReader"));
24    
25     unsigned int EventReader::maxPackets = 0;
26 kusanagi 1.7 unsigned int EventReader::prevPckCounter = 0;
27     unsigned int EventReader::prevPckOBT = 0;
28 kusanagi 1.10
29    
30 kusanagi 1.1 /**
31     * Constructor.
32     */
33 kusanagi 1.10 EventReader::EventReader(int packetsLimit = -1):
34     TechmodelAlgorithm(0, "TechmodelEventReader"){
35     EventReader::maxPackets = packetsLimit;
36     logger->debug(_T("Constructor"));
37 kusanagi 1.1 Header = new EventHeader();
38 kusanagi 1.5
39 kusanagi 2.5 TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::PhysEndRun, new PhysEndRunReader));
40     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibCalPulse1, new CalibCalPulse1Reader));
41     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibCalPulse2, new CalibCalPulse2Reader));
42     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Physics, new PhysicsReader));
43     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTrkBoth, new CalibTrkBothReader));
44     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTrk1, new CalibTrk1Reader));
45     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTrk2, new CalibTrk2Reader));
46     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTrd, new CalibTrdReader));
47     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTof, new CalibTofReader));
48     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibS4, new CalibS4Reader));
49     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibCalPed, new CalibCalPedReader));
50     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibAc, new CalibAcReader));
51     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::RunHeader, new RunHeaderReader));
52     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::RunTrailer, new RunTrailerReader));
53     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibHeader, new CalibHeaderReader));
54     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalibTrailer, new CalibTrailerReader));
55     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::InitHeader, new InitHeaderReader));
56     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::InitTrailer, new InitTrailerReader));
57     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::EventTrk, new EventTrkReader));
58     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TestTrk, new TestTrkReader));
59     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TestTof, new TestTofReader));
60     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Log, new LogReader));
61     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::VarDump, new VarDumpReader));
62     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::ArrDump, new ArrDumpReader));
63     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TabDump, new TabDumpReader));
64     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Tmtc, new TmtcReader));
65     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::Mcmd, new McmdReader));
66     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::ForcedFECmd, new ForcedFECmdReader));
67     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::AcInit, new AcInitReader));
68     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalInit, new CalInitReader));
69     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TrkInit, new TrkInitReader));
70     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TofInit, new TofInitReader));
71     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::TrgInit, new TrgInitReader));
72     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::NdInit, new NdInitReader));
73     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::S4Init, new S4InitReader));
74     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::CalAlarm, new CalAlarmReader));
75     TechmodelAlgorithmMap.insert(AlgorithmMap::value_type(PacketType::AcAlarm, new AcAlarmReader));
76     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 1.1 }
81    
82     /**
83     * Get a string with the version info of the algorithm.
84     */
85     std::string EventReader::GetVersionInfo(void) const {
86     return
87 kusanagi 2.5 "$Header: /home/cvsmanager/yoda/techmodel/EventReader.cpp,v 2.4 2004/12/03 22:08:00 kusanagi Exp $\n";
88 kusanagi 1.1 }
89    
90     /**
91     * Initialize the algorithm with a special run. This will initialize the
92     * event reader routines for all packet types.
93     */
94     void EventReader::Init(PamelaRun *run) {
95     SetInputStream(run);
96    
97     //Create the structure of directories and create xxx.Header.root files
98     run->WriteHeaders(this, &Header);
99    
100     //Create the xxx.root in it's specific directory
101     for (AlgorithmMap::iterator i = TechmodelAlgorithmMap.begin();
102     i != TechmodelAlgorithmMap.end(); i++) {
103 kusanagi 2.4 oss.str("");
104 kusanagi 1.10 oss << "Initializing algo " << i->second->GetAlgorithmName();
105     logger->debug(oss.str().c_str());
106 kusanagi 1.1 i->second->Init(run);
107     }
108     Run = dynamic_cast<TechmodelPamelaRun*>(run);
109     }
110    
111     static void SkipToNextHeader(ifstream *);
112    
113     /**
114     * Read the next event header, call the reader algorithms that
115     * correspond to its packet type, and read the event trailer.
116     */
117    
118     // 15 June 2004 ---note------------------
119     // A nice refacoring would require to not read again the packet data (which is
120 kusanagi 2.4 // read in the UnpackPscuHeader() and put directly in the
121 kusanagi 1.1 // EventAlgorithm->RunEvent(....) directly the data inside the packet.... will see later....
122     // 15 June 2004 ---note------------------
123     void EventReader::RunEvent(int EventNumber) {
124     //for now i'll suppose that the raw file starts immediately with the right bytes
125     //to insert a GetPacketStart()
126 kusanagi 1.10 stringstream oss;
127     int step = 0;
128 kusanagi 2.5 const PacketType* type;
129 kusanagi 1.10 while (!InputFile->eof() && ((step++ < maxPackets) || (maxPackets == 0))){
130 kusanagi 1.1 try {
131     if (FindStart()) {
132 kusanagi 2.4 UnpackPscuHeader();
133 kusanagi 2.5 type = Header->GetPscuHeader()->GetPacketType();
134 kusanagi 1.1 AlgorithmMap::iterator i = TechmodelAlgorithmMap.find(type);
135     if (i != TechmodelAlgorithmMap.end()) {
136 kusanagi 2.5 TechmodelAlgorithm *EventAlgorithm(i->second);
137 kusanagi 1.1 EventAlgorithm->RunEvent(EventNumber, Header->GetPscuHeader()->GetPacketLenght());
138     Run->FillTrees(type);
139     Header->GetCounter()->Increment(type);
140 kusanagi 2.4 logger->info(Header->GetPscuHeader()->Print());
141 kusanagi 1.1 } else {
142 kusanagi 2.4 throw NotExistingAlgorithmException(type->GetName().c_str()); //to exctract to an higher level and delete the logger!
143 kusanagi 2.3 }
144     }
145 kusanagi 2.4 // In case of exception have to save the packet in a specific root file??
146     } catch (NotExistingAlgorithmException exc) {
147 kusanagi 2.5 oss.str("");
148     oss << exc.print() << " " << Header->GetPscuHeader()->Print();
149     logger->error(oss.str().c_str());
150 kusanagi 2.4 } catch (WrongCRCHeaderException exc) {
151 kusanagi 2.5 oss.str("");
152     oss << exc.print() << " " << Header->GetPscuHeader()->Print();
153     logger->error(oss.str().c_str());
154 kusanagi 2.4 } catch (WrongCRCException exc) {
155 kusanagi 2.5 oss.str("");
156     oss << exc.print() << " " << Header->GetPscuHeader()->Print();
157     logger->error(oss.str().c_str());
158 kusanagi 2.4 } catch (UnidentifiedPacketException exc) {
159 kusanagi 2.5 oss.str("");
160     oss << exc.print() << " " << Header->GetPscuHeader()->Print();
161     logger->error(oss.str().c_str());
162 kusanagi 2.4 } catch (NotExistingCounterException exc) {
163 kusanagi 2.5 oss.str("");
164     oss << exc.print() << " " << Header->GetPscuHeader()->Print();
165     logger->error(oss.str().c_str());
166 kusanagi 2.4 } catch (LengthException exc) {
167 kusanagi 2.5 oss.str("");
168     oss << exc.print() << " " << Header->GetPscuHeader()->Print();
169     logger->error(oss.str().c_str());
170 kusanagi 1.1 } catch (...) {
171 kusanagi 2.4 logger->error("Couldn't read the event. Skipping to the next header. \n");
172 kusanagi 1.1 }
173 kusanagi 2.1 if ((step%1000) == 0) std::cout << step/1000 << "K \n";
174 kusanagi 1.1 }
175 kusanagi 1.10 Header->GetCounter()->PrintCounters();
176 kusanagi 1.1 }
177    
178     static void SkipToNextHeader(ifstream* TechmodelFile) {
179     // yeah.
180     }
181    
182    
183    
184     /**
185     * Unpack the PSCU header from a file into the structure.
186     */
187 kusanagi 2.4 void EventReader::UnpackPscuHeader(void) throw (WrongCRCException, LengthException) {
188 kusanagi 1.10 stringstream oss;
189 kusanagi 2.4 int response = false;
190 kusanagi 1.1 char buff[16];
191     InputFile->read(buff, sizeof(buff));
192    
193    
194     unsigned char PacketId1 = buff[3];
195     unsigned char PacketId2 = buff[4];
196     unsigned int Counter = (((UINT32)buff[5]<<16)&0x00FF0000) + (((UINT32)buff[6]<<8)&0x0000FF00) + (((UINT32)buff[7])&0x000000FF);
197     unsigned int OrbitalTime = (((UINT32)buff[8]<<24)&0xFF000000) + (((UINT32)buff[9]<<16)&0x00FF0000) + (((UINT32)buff[10]<<8)&0x0000FF00) + (((UINT32)buff[11])&0x000000FF);
198     unsigned int PacketLenght = (((UINT32)buff[12]<<16)&0x00FF0000) + (((UINT32)buff[13]<<8)&0x0000FF00) + (((UINT32)buff[14])&0x000000FF);
199     unsigned char CRC = buff[15];
200 kusanagi 1.9 unsigned char FileOffset = buff[15];
201 kusanagi 1.1
202     if (Counter < prevPckCounter){
203 kusanagi 2.4 oss.str("");
204 kusanagi 1.10 oss << "Packet counter is less than before of " << (prevPckCounter - Counter);
205 kusanagi 2.4 logger->warn(oss.str().c_str());
206 kusanagi 1.1 }
207    
208     if (OrbitalTime < prevPckOBT){
209 kusanagi 2.4 oss.str("");
210     oss << " Onboard Time is less than before of " << (prevPckOBT - OrbitalTime);
211     logger->warn(oss.str().c_str());
212 kusanagi 1.1 }
213    
214 kusanagi 1.7 if (((BYTE)CM_Compute_CRC16(0, (BYTE*)&buff, 15) == (BYTE)buff[15]) && (PacketId1 == PacketId2)){
215     prevPckCounter = Counter;
216     prevPckOBT = OrbitalTime;
217 kusanagi 1.1 long int initPos = InputFile->tellg();
218     long int finalPos;
219     Header->GetPscuHeader()->SetPacketId(PacketId1, PacketId2);
220     Header->GetPscuHeader()->SetCounter(Counter);
221     Header->GetPscuHeader()->SetOrbitalTime(OrbitalTime);
222     //PacketLength is the length of the whole DATApacket starting from the first byte after the header
223     //plus the CRC legth (which varies for each type of packet)
224     Header->GetPscuHeader()->SetPacketLenght(PacketLenght);
225     Header->GetPscuHeader()->SetCRC(CRC);
226 kusanagi 1.9 Header->GetPscuHeader()->SetFileOffset(((long int)(InputFile->tellg()) - 16));
227 kusanagi 1.1
228     //commented out because of the above test code
229     InputFile->seekg(Header->GetPscuHeader()->GetPacketLenght(), std::ios::cur);
230     FindStart();
231     finalPos = (long int)InputFile->tellg() - (1 + initPos + (long int)(Header->GetPscuHeader()->GetPacketLenght()));
232     if(finalPos == 0){
233 kusanagi 1.10 logger->debug(_T("Correct packet length"));
234 kusanagi 1.1 }
235     if (finalPos > 0 && finalPos < 64) {
236 kusanagi 2.4 oss.str("");
237 kusanagi 1.10 oss << " Correct packet length: Padded of " << finalPos << " bytes";
238 kusanagi 2.4 logger->debug(oss.str().c_str());
239 kusanagi 1.1 }
240     if (finalPos > 64){
241 kusanagi 2.4 oss.str("");
242     oss << "The begin of the next packet is far more than 64 byte from the end of the previous."
243     << Header->GetPscuHeader()->Print();
244 kusanagi 2.5 logger->error(oss.str().c_str());
245 kusanagi 2.4 //throw LengthException("The begin of the next packet is far more than 64 byte from the end of the previous.");
246 kusanagi 1.1 }
247     InputFile->seekg(initPos, std::ios::beg);
248     } else {
249 kusanagi 1.8 InputFile->seekg(-(13), std::ios::cur);
250 kusanagi 2.4 throw WrongCRCHeaderException();
251 kusanagi 1.1 }
252 kusanagi 2.4
253     /* char tmpId1[4];
254 kusanagi 1.1 char tmpId2[4];
255     char tmpLength[12];
256     char tmpStart[100];
257     char tmpCRC[4];
258     sprintf(tmpId1, "%02X", PacketId1);
259     sprintf(tmpId2, "%02X", PacketId2);
260 kusanagi 1.4 sprintf(tmpLength, "%06X", Header->GetPscuHeader()->GetPacketLenght());
261 kusanagi 1.9 sprintf(tmpStart, "%X", Header->GetPscuHeader()->GetFileOffset());
262 kusanagi 1.1 sprintf(tmpCRC, "%02X", CRC);
263 kusanagi 1.10 oss.flush();
264     oss << "\n Packet Counter (decimal) : " << Counter
265 kusanagi 1.1 << "\n Id1 - Id2 : " << tmpId1 << " - " << tmpId2
266     << "\n Orbital Time (decimal) : " << OrbitalTime
267     << "\n Lenght : " << tmpLength
268     << "\n CRC : " << tmpCRC
269 kusanagi 1.10 << "\n Header Start Position : " << tmpStart;
270     logger->info(oss.str().c_str());
271 kusanagi 2.4 */
272 kusanagi 1.1 }
273    
274     /**
275     * Unpack the trailer of a PSCU event into the structure.
276     */
277     void EventReader::UnpackPscuTrailer(void) throw (std::exception) {
278    
279     }
280    
281     /**
282     * Find the next starting poin for the PSCU event looking for a {0xFA, 0xFE, 0xDE} sequence
283     */
284     int EventReader::FindStart(void) throw (std::exception) {
285     //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 1.10
298     int buffSize = 100;
299     int index = 0;
300 kusanagi 2.4 int loop = -1;
301 kusanagi 1.10 char buffer[buffSize];
302    
303     while (!InputFile->eof()) {
304     InputFile->read(buffer, sizeof(buffer));
305     index = 0;
306 kusanagi 2.4 loop++;
307 kusanagi 1.10 while (index < buffSize){
308     dataByte = buffer[index++];
309     if (dataByte == (char)(*(subSign+subIndex))){
310     if (subIndex++ == (subSignDim-1)) {
311 kusanagi 2.4 InputFile->seekg( (index - (subIndex + buffSize)), std::ios::cur);
312     return 1;
313     }
314 kusanagi 1.10 } else {
315 kusanagi 2.4 index = index - (subIndex);
316 kusanagi 1.10 subIndex = 0;
317     }
318     }
319 kusanagi 2.4 //Needs to guarantee the overap of the buffer(s) in several loop
320     InputFile->seekg( (-1)*(subSignDim + 1) , std::ios::cur);
321 kusanagi 1.10 }
322 kusanagi 1.1 return 0;
323     }
324    
325     ClassImp(EventReader)

  ViewVC Help
Powered by ViewVC 1.1.23