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

Contents of /yoda/techmodel/EventReader.cpp

Parent Directory Parent Directory | Revision Log Revision Log


Revision 2.5 - (show annotations) (download)
Thu Dec 9 08:48:41 2004 UTC (20 years 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 /** @file
2 * $Author: kusanagi $
3 * $Date: 2004/12/03 22:08:00 $
4 * $Revision: 2.4 $
5 *
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 #include <log4cxx/logger.h>
11 #include <fstream>
12 #include "EventReader.h"
13 #include "ReaderAlgorithms.h"
14
15
16 extern "C" {
17 #include "CRC.h"
18 }
19
20 using namespace pamela;
21 using namespace pamela::techmodel;
22
23 static log4cxx::LoggerPtr logger = log4cxx::Logger::getLogger(_T("pamela.techmodel.EventReader"));
24
25 unsigned int EventReader::maxPackets = 0;
26 unsigned int EventReader::prevPckCounter = 0;
27 unsigned int EventReader::prevPckOBT = 0;
28
29
30 /**
31 * Constructor.
32 */
33 EventReader::EventReader(int packetsLimit = -1):
34 TechmodelAlgorithm(0, "TechmodelEventReader"){
35 EventReader::maxPackets = packetsLimit;
36 logger->debug(_T("Constructor"));
37 Header = new EventHeader();
38
39 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 }
81
82 /**
83 * Get a string with the version info of the algorithm.
84 */
85 std::string EventReader::GetVersionInfo(void) const {
86 return
87 "$Header: /home/cvsmanager/yoda/techmodel/EventReader.cpp,v 2.4 2004/12/03 22:08:00 kusanagi Exp $\n";
88 }
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 oss.str("");
104 oss << "Initializing algo " << i->second->GetAlgorithmName();
105 logger->debug(oss.str().c_str());
106 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 // read in the UnpackPscuHeader() and put directly in the
121 // 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 stringstream oss;
127 int step = 0;
128 const PacketType* type;
129 while (!InputFile->eof() && ((step++ < maxPackets) || (maxPackets == 0))){
130 try {
131 if (FindStart()) {
132 UnpackPscuHeader();
133 type = Header->GetPscuHeader()->GetPacketType();
134 AlgorithmMap::iterator i = TechmodelAlgorithmMap.find(type);
135 if (i != TechmodelAlgorithmMap.end()) {
136 TechmodelAlgorithm *EventAlgorithm(i->second);
137 EventAlgorithm->RunEvent(EventNumber, Header->GetPscuHeader()->GetPacketLenght());
138 Run->FillTrees(type);
139 Header->GetCounter()->Increment(type);
140 logger->info(Header->GetPscuHeader()->Print());
141 } else {
142 throw NotExistingAlgorithmException(type->GetName().c_str()); //to exctract to an higher level and delete the logger!
143 }
144 }
145 // In case of exception have to save the packet in a specific root file??
146 } catch (NotExistingAlgorithmException exc) {
147 oss.str("");
148 oss << exc.print() << " " << Header->GetPscuHeader()->Print();
149 logger->error(oss.str().c_str());
150 } catch (WrongCRCHeaderException exc) {
151 oss.str("");
152 oss << exc.print() << " " << Header->GetPscuHeader()->Print();
153 logger->error(oss.str().c_str());
154 } catch (WrongCRCException exc) {
155 oss.str("");
156 oss << exc.print() << " " << Header->GetPscuHeader()->Print();
157 logger->error(oss.str().c_str());
158 } catch (UnidentifiedPacketException exc) {
159 oss.str("");
160 oss << exc.print() << " " << Header->GetPscuHeader()->Print();
161 logger->error(oss.str().c_str());
162 } catch (NotExistingCounterException exc) {
163 oss.str("");
164 oss << exc.print() << " " << Header->GetPscuHeader()->Print();
165 logger->error(oss.str().c_str());
166 } catch (LengthException exc) {
167 oss.str("");
168 oss << exc.print() << " " << Header->GetPscuHeader()->Print();
169 logger->error(oss.str().c_str());
170 } catch (...) {
171 logger->error("Couldn't read the event. Skipping to the next header. \n");
172 }
173 if ((step%1000) == 0) std::cout << step/1000 << "K \n";
174 }
175 Header->GetCounter()->PrintCounters();
176 }
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 void EventReader::UnpackPscuHeader(void) throw (WrongCRCException, LengthException) {
188 stringstream oss;
189 int response = false;
190 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 unsigned char FileOffset = buff[15];
201
202 if (Counter < prevPckCounter){
203 oss.str("");
204 oss << "Packet counter is less than before of " << (prevPckCounter - Counter);
205 logger->warn(oss.str().c_str());
206 }
207
208 if (OrbitalTime < prevPckOBT){
209 oss.str("");
210 oss << " Onboard Time is less than before of " << (prevPckOBT - OrbitalTime);
211 logger->warn(oss.str().c_str());
212 }
213
214 if (((BYTE)CM_Compute_CRC16(0, (BYTE*)&buff, 15) == (BYTE)buff[15]) && (PacketId1 == PacketId2)){
215 prevPckCounter = Counter;
216 prevPckOBT = OrbitalTime;
217 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 Header->GetPscuHeader()->SetFileOffset(((long int)(InputFile->tellg()) - 16));
227
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 logger->debug(_T("Correct packet length"));
234 }
235 if (finalPos > 0 && finalPos < 64) {
236 oss.str("");
237 oss << " Correct packet length: Padded of " << finalPos << " bytes";
238 logger->debug(oss.str().c_str());
239 }
240 if (finalPos > 64){
241 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 logger->error(oss.str().c_str());
245 //throw LengthException("The begin of the next packet is far more than 64 byte from the end of the previous.");
246 }
247 InputFile->seekg(initPos, std::ios::beg);
248 } else {
249 InputFile->seekg(-(13), std::ios::cur);
250 throw WrongCRCHeaderException();
251 }
252
253 /* char tmpId1[4];
254 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 sprintf(tmpLength, "%06X", Header->GetPscuHeader()->GetPacketLenght());
261 sprintf(tmpStart, "%X", Header->GetPscuHeader()->GetFileOffset());
262 sprintf(tmpCRC, "%02X", CRC);
263 oss.flush();
264 oss << "\n Packet Counter (decimal) : " << Counter
265 << "\n Id1 - Id2 : " << tmpId1 << " - " << tmpId2
266 << "\n Orbital Time (decimal) : " << OrbitalTime
267 << "\n Lenght : " << tmpLength
268 << "\n CRC : " << tmpCRC
269 << "\n Header Start Position : " << tmpStart;
270 logger->info(oss.str().c_str());
271 */
272 }
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 const int subSignDim = 3;
293 const unsigned char subSign[subSignDim]={0xFA, 0xFE, 0xDE};
294 //------------------------------------------
295 int subIndex = 0;
296 char dataByte;
297
298 int buffSize = 100;
299 int index = 0;
300 int loop = -1;
301 char buffer[buffSize];
302
303 while (!InputFile->eof()) {
304 InputFile->read(buffer, sizeof(buffer));
305 index = 0;
306 loop++;
307 while (index < buffSize){
308 dataByte = buffer[index++];
309 if (dataByte == (char)(*(subSign+subIndex))){
310 if (subIndex++ == (subSignDim-1)) {
311 InputFile->seekg( (index - (subIndex + buffSize)), std::ios::cur);
312 return 1;
313 }
314 } else {
315 index = index - (subIndex);
316 subIndex = 0;
317 }
318 }
319 //Needs to guarantee the overap of the buffer(s) in several loop
320 InputFile->seekg( (-1)*(subSignDim + 1) , std::ios::cur);
321 }
322 return 0;
323 }
324
325 ClassImp(EventReader)

  ViewVC Help
Powered by ViewVC 1.1.23