source: Sophya/trunk/AddOn/TAcq/racquproc.cc

Last change on this file was 4016, checked in by ansari, 14 years ago

Ajout de commentaires d'autodocumentation Doxygen, Reza 12/08/2011
File size: 34.0 KB
Line 
1#include "racquproc.h"
2
3/* ----------------------------------------
4 Projet BAORadio --- LAL
5 2008 - 2010
6------------------------------------------- */
7
8#include <stdlib.h>
9#include <unistd.h>
10#include <fstream>
11#include <signal.h>
12
13#include "pexceptions.h"
14#include "tvector.h"
15#include "fioarr.h"
16#include "timestamp.h"
17#include "fftpserver.h"
18#include "fftwserver.h"
19#include "histos.h"
20#include "histos2.h"
21
22#include "FFTW/fftw3.h"
23
24
25#include "pciewrap.h"
26#include "brpaqu.h"
27#include "minifits.h"
28
29/* Fonction, module^2 des nombres complexes */
30static inline r_4 Zmod2(complex<r_4> z)
31{ return (z.real()*z.real()+z.imag()*z.imag()); }
32static inline r_8 Zmod2(complex<r_8> z)
33{ return (z.real()*z.real()+z.imag()*z.imag()); }
34static inline r_4 Zmod2(TwoByteComplex z)
35{ return ((r_4)z.realB()*(r_4)z.realB()+(r_4)z.imagB()*(r_4)z.imagB()); }
36
37//---------------------------------------------------------------------
38// Classe thread de traitement/monitoring multifibre Raw/FFT
39//---------------------------------------------------------------------
40/*!
41 \class MonitorProc
42 \ingroup TAcq
43
44 \brief Monitoring thread class for BAORadio/CRT acquisition program.
45
46 This class can handle data from Raw data firmware, as well as FFT firmware,
47 one and two channels per fiber.
48*/
49
50/* --Methode-- */
51MonitorProc::MonitorProc(RAcqMemZoneMgr& mem)
52 : memgr(mem)
53{
54 BRAcqConfig bpar;
55 par_.Set(bpar.GetParams());
56 nmax_ = par_.nmaxProc;
57 if (nmax_==0) nmax_=par_.MaxNbBlocs();
58 nmean_ = par_.nmeanProc;
59 step_ = par_.stepProc;
60 stop_ = false;
61 path_ = bpar.OutputDirectory();
62 nfiles_ = 0;
63 nblocproc_ = 0;
64 nprocpaq_=0;
65 npaqsamefc_=0;
66 totnprocpaq_=0;
67 totnpaqsamefc_=0;
68 curfc_.SetSize(memgr.NbFibres(), memgr.NbPaquets());
69 cpaqok_.SetSize(memgr.NbFibres(), memgr.NbPaquets());
70 SetMemZAction();
71}
72
73/* --Methode-- */
74MonitorProc::~MonitorProc()
75{
76 // cout << " **** DBG ***** MonitorProc::~MonitorProc() " << endl;
77}
78
79/* --Methode-- */
80MemZStatus MonitorProc::SetMemZAction(MemZaction mmact)
81{
82 mmact_=mmact;
83 mmsta_=MemZS_Proc;
84 switch (mmact) {
85 case MemZA_ProcA:
86 mmsta_=MemZS_ProcA;
87 break;
88 case MemZA_ProcB:
89 mmsta_=MemZS_ProcB;
90 break;
91 case MemZA_ProcC:
92 mmsta_=MemZS_ProcC;
93 break;
94 case MemZA_ProcD:
95 mmsta_=MemZS_ProcD;
96 break;
97 case MemZA_ProcE:
98 mmsta_=MemZS_ProcE;
99 break;
100 case MemZA_ProcF:
101 mmsta_=MemZS_ProcF;
102 break;
103 default:
104 mmact_=MemZA_Proc;
105 mmsta_=MemZS_Proc;
106 break;
107 }
108 return mmsta_;
109}
110
111/* --Methode-- */
112void MonitorProc::Stop()
113{
114 stop_=true;
115}
116
117/* --Methode-- */
118void MonitorProc::run()
119{
120 setRC(1);
121 int rc=0;
122 try {
123 TimeStamp ts;
124 cout << " MonitorProc::run() - Starting " << ts << " NMaxMemZones=" << nmax_
125 << " NMean=" << nmean_ << " Step=" << step_ << endl;
126 cout << " MonitorProc::run()... - Output Data Path: " << path_ << endl;
127 char fname[512];
128 sprintf(fname,"%s/monproc.log",path_.c_str());
129 ofstream filog(fname);
130 filog << " MonitorProc::run() - starting log file " << ts << endl;
131 filog << " ... NMaxMemZones=" << nmax_ << " NMean=" << nmean_ << " Step=" << step_ << endl;
132 uint_4 paqsz = memgr.PaqSize();
133 BRPaquet pq(paqsz);
134 if (par_.fgsinglechannel) {
135 spectre_.SetSize(memgr.NbFibres(), pq.DataSize()/2);
136 for(int kc=0; kc<memgr.NbFibres(); kc++) nzm_.push_back(0);
137 rc=procData1C(filog);
138 }
139 else {
140 spectre_.SetSize(2*memgr.NbFibres(), pq.DataSize()/4);
141 for(int kc=0; kc<2*memgr.NbFibres(); kc++) nzm_.push_back(0);
142 rc=procData2C(filog);
143 }
144 cout << " ---- MonitorProc::run()/End NBlocProcessed=" << nblocproc_
145 << " NFiles=" << nfiles_ << " Rc=" << rc << endl;
146 ts.SetNow();
147 filog << " ---- MonitorProc::run()/End " << ts << endl;
148 filog << " --------- MonitorProc::run()/End NBlocProcessed=" << nblocproc_
149 << " NFiles=" << nfiles_ << " Rc=" << rc << endl;
150 }
151 catch (std::exception& exc) {
152 cout << " MonitorProc::run()/catched std::exception " << exc.what() << endl;
153 setRC(98);
154 return;
155 }
156 catch(...) {
157 cout << " MonitorProc::run()/catched unknown ... exception " << endl;
158 setRC(99);
159 return;
160 }
161
162 setRC(rc);
163 return;
164}
165
166/* --Methode-- */
167int MonitorProc::procData1C(ofstream& filog)
168{
169 BRPaqChecker pcheck[MAXNBFIB]; // Verification/comptage des paquets
170// Initialisation pour calcul FFT
171 uint_4 paqsz = memgr.PaqSize();
172 BRPaquet pq(paqsz);
173 TVector<r_4> vx(pq.DataSize());
174 vx = (r_4)(0.);
175 TVector< complex<r_4> > cfour(pq.DataSize()/2+1); // composant TF
176
177 fftwf_plan plan = fftwf_plan_dft_r2c_1d(vx.Size(), vx.Data(),
178 (fftwf_complex *)cfour.Data(), FFTW_ESTIMATE);
179
180 // Histo pour valeurs des bytes dans les paquets
181 Histo* phist[MAXNBFIB];
182 Histo2D* ph2[MAXNBFIB];
183 Histo* phexp[MAXNBFIB];
184 TMatrix<r_4>* psatur[MAXNBFIB];
185 TVector<uint_4>* pvsatfreq[MAXNBFIB];
186 for(int ifib=0; ifib<MAXNBFIB; ifib++) {
187 phist[ifib]=NULL; ph2[ifib]=NULL; phexp[ifib]=NULL; psatur[ifib]=NULL;
188 }
189 if (par_.fgdatafft) { // data de type FFT
190 for(sa_size_t lc=0; lc<memgr.NbFibres(); lc++) {
191 phist[lc] = new Histo(-128.5,+128.5,257);
192 ph2[lc] = new Histo2D(-128.5,+128.5,257, -128.5,+128.5,257);
193 phexp[lc] = new Histo(-128.5,+128.5,257);
194 psatur[lc] = new TMatrix<r_4>(3,3);
195 pvsatfreq[lc] = new TVector<uint_4>(spectre_.NCols());
196 *psatur[lc] = 0.;
197 }
198 }
199 else {
200 for(sa_size_t lc=0; lc<memgr.NbFibres(); lc++)
201 phist[lc] = new Histo(-0.5,256.5,257);
202 }
203
204 TimeStamp ts;
205 char fname[512];
206 nfiles_ = 0;
207 for (uint_4 kmz=0; kmz<nmax_; kmz++) {
208 if (stop_) break;
209 if (memgr.GetRunState() == MemZR_Stopped) break;
210
211 int mid = memgr.FindMemZoneId(mmact_); // MemZA_Proc
212 Byte* buffg = memgr.GetMemZone(mid);
213 if (buffg == NULL) {
214 cout << " MonitorProc::procData1C()/ERROR memgr.GetMemZone(" << mid << ") -> NULL" << endl;
215 break;
216 }
217 if ((step_>1)&&(kmz%step_ != 0)) {
218 memgr.FreeMemZone(mid, mmsta_); // MemZS_Proc);
219 continue;
220 }
221 sa_size_t lc=0;
222 Byte* fbuff[MAXNBFIB];
223 for(uint_4 fib=0; fib<memgr.NbFibres(); fib++) { // Boucle sur les fibres
224 fbuff[fib] = memgr.GetMemZone(mid,fib);
225 if (fbuff[fib] == NULL) { // cela ne devrait pas arriver
226 cout << " MonitorProc::procData1C()/ERROR memgr.GetMemZone(" << mid << "," << fib << ") -> NULL" << endl;
227 return 9;
228 }
229 }
230
231 // DBG-ATTENTION : freq 0 pour expo full FFT si reordonne
232 // int idxexpo=(par_.fgfftshrink)?1023:0; // exposant FFT shrink 1024 freq, ou freq 0 pour full-FFT
233 int idxexpo=0;
234
235 cpaqok_ = (uint_1)0;
236 curfc_ = (uint_8)0;
237 for(uint_4 fib=0; fib<memgr.NbFibres(); fib++) {
238 for(uint_4 i=0; i<memgr.NbPaquets(); i++) {
239 BRPaquet paq(fbuff[fib]+i*paqsz, paqsz);
240 bool pqok=pcheck[fib].Check(paq,curfc_(fib,i)); // Verification du paquet / FrameCounter
241 if (!pqok) continue;
242 cpaqok_(fib,i) = 1;
243 sa_size_t lc=fib;
244 if (par_.fgdatafft) { // Traitement data de type FFT
245 TwoByteComplex* tbcp=paq.Data1C();
246
247 // exposant FFT
248 phexp[lc]->Add((r_4)tbcp[idxexpo].realD());
249
250 for(sa_size_t j=1; j<spectre_.NCols(); j++) {
251 phist[lc]->Add((r_4)tbcp[j].realD());
252 phist[lc]->Add((r_4)tbcp[j].imagD());
253 ph2[lc]->Add((r_4)tbcp[j].realD(), (r_4)tbcp[j].imagD());
254 // comptage saturation
255 int sir=0, sii=0; // saturation partie reelle, partie imaginaire
256 if (tbcp[j].realI()==-128) sir=-1;
257 else if (tbcp[j].realI()==127) sir=1;
258 if (tbcp[j].imagI()==-128) sii=-1;
259 else if (tbcp[j].imagI()==127) sii=1;
260 (*psatur[lc])(sir+1,sii+1)+=1.;
261 if ((sir!=0)||(sii!=0)) (*pvsatfreq[lc])(j)+=1;
262 spectre_(lc,j) += Zmod2(tbcp[j]);
263 }
264 nzm_[lc]++;
265 }
266 else { // Traitement RawData
267 for(sa_size_t j=0; j<vx.Size(); j++) {
268 phist[lc]->Add((r_8)(*(paq.Data1()+j)));
269 vx(j) = (r_4)(*(paq.Data1()+j))-127.5;
270 }
271 fftwf_execute(plan);
272 // ffts_.FFTForward(vx, cfour_);
273 for(sa_size_t j=0; j<spectre_.NCols(); j++)
274 spectre_(lc,j) += Zmod2(cfour(j+1));
275 nzm_[lc]++; lc++;
276 }
277 } // FIN de la boucle sur les paquets
278 } // Boucle sur les fibres
279 memgr.FreeMemZone(mid, mmsta_); // MemZS_Proc);
280 CheckFrameCounters();
281
282 nblocproc_ ++;
283 totnprocpaq_ += memgr.NbPaquets(); nprocpaq_ += memgr.NbPaquets();
284 bool fgnzm=true;
285 for(int lc=0; lc<memgr.NbFibres(); lc++)
286 if (nzm_[lc]<nmean_) fgnzm=false;
287
288 if (fgnzm) {
289 char buff[32];
290 for(sa_size_t lc=0; lc<memgr.NbFibres(); lc++) {
291 spectre_.Row(lc) /= (r_4)nzm_[lc];
292 sprintf(buff,"NPaqMoy%d",(int)lc);
293 spectre_.Info()[buff] = nzm_[lc];
294 }
295 sprintf(fname,"%s/meanspec%d.ppf",path_.c_str(),(int)nfiles_);
296 nfiles_++;
297 POutPersist po(fname);
298 po << PPFNameTag("spectre") << spectre_;
299 spectre_ = (r_4)(0.);
300 char buftag[32];
301 for(int lc=0; lc<memgr.NbFibres(); lc++) {
302 sprintf(buftag,"hvalV%d",(int)lc);
303 po << PPFNameTag(buftag) << (*phist[lc]);
304 phist[lc]->Zero();
305 if (par_.fgdatafft) { // data de type FFT
306 sprintf(buftag,"h2dV%d",(int)lc);
307 po << PPFNameTag(buftag) << (*ph2[lc]);
308 ph2[lc]->Zero();
309 sprintf(buftag,"hexpV%d",(int)lc);
310 po << PPFNameTag(buftag) << (*phexp[lc]);
311 phexp[lc]->Zero();
312 sprintf(buftag,"saturV%d",(int)lc);
313 po << PPFNameTag(buftag) << (*psatur[lc]);
314 (*psatur[lc])=0.;
315 sprintf(buftag,"satfreqV%d",(int)lc);
316 po << PPFNameTag(buftag) << (*pvsatfreq[lc]);
317 (*pvsatfreq[lc])=0;
318 }
319 nzm_[lc]=0;
320 }
321 ts.SetNow();
322 // Calcul / impression fraction des paquets avec same-framecounter
323 int fracsame=0;
324 if (nprocpaq_>0) fracsame=100*npaqsamefc_/nprocpaq_;
325 int totfracsame=0;
326 if (totnprocpaq_>0) totfracsame=100*totnpaqsamefc_/totnprocpaq_;
327 filog << ts << " : proc file (meanspectra) " << fname << endl;
328 filog << " NBlocProcessed=" << nblocproc_ << " NSameFC=" << totnpaqsamefc_ << " / " << totnprocpaq_
329 << " -> " << totfracsame << " % (LastPqs: " << npaqsamefc_ << " / " << nprocpaq_
330 << " -> " << fracsame << " % )" << endl;
331 cout << " MonitorProc::procData1C() " << ts << " : created file " << fname << endl;
332 cout << " NBlocProcessed=" << nblocproc_ << " NSameFC=" << totnpaqsamefc_ << " / " << totnprocpaq_
333 << " -> " << totfracsame << " % (LastPqs: " << npaqsamefc_ << " / " << nprocpaq_
334 << " -> " << fracsame << " % )" << endl;
335 nprocpaq_=npaqsamefc_=0;
336 }
337 } // Fin de boucle sur les kmz ( bloc MemZoneMgr a traiter )
338
339 bool fgnzm=false;
340 for(int lc=0; lc<memgr.NbFibres(); lc++)
341 if (nzm_[lc]>0) fgnzm=true;
342
343 if (fgnzm) {
344 char buff[32];
345 for(sa_size_t lc=0; lc<memgr.NbFibres(); lc++) {
346 if (nzm_[lc]>0) spectre_.Row(lc) /= (r_4)nzm_[lc];
347 sprintf(buff,"NPaqMoy%d",(int)lc);
348 spectre_.Info()[buff] = nzm_[lc];
349 }
350 sprintf(fname,"%s/meanspec%d.ppf",path_.c_str(),(int)nfiles_);
351 POutPersist po(fname);
352 po << PPFNameTag("spectre") << spectre_;
353 spectre_ = (r_4)(0.);
354 char buftag[32];
355 for(int lc=0; lc<memgr.NbFibres(); lc++) {
356 sprintf(buftag,"hvalV%d",(int)lc);
357 po << PPFNameTag(buftag) << (*phist[lc]);
358 delete phist[lc];
359 if (par_.fgdatafft) { // data de type FFT
360 sprintf(buftag,"h2dV%d",(int)lc);
361 po << PPFNameTag(buftag) << (*ph2[lc]);
362 delete ph2[lc];
363 sprintf(buftag,"hexpV%d",(int)lc);
364 po << PPFNameTag(buftag) << (*phexp[lc]);
365 delete phexp[lc];
366 sprintf(buftag,"saturV%d",(int)lc);
367 po << PPFNameTag(buftag) << (*psatur[lc]);
368 sprintf(buftag,"satfreqV%d",(int)lc);
369 po << PPFNameTag(buftag) << (*pvsatfreq[lc]);
370 delete psatur[lc];
371 delete pvsatfreq[lc];
372 }
373 nzm_[lc]=0;
374 }
375 ts.SetNow();
376 // Calcul / impression fraction des paquets avec same-framecounter
377 int fracsame=0;
378 if (nprocpaq_>0) fracsame=100*npaqsamefc_/nprocpaq_;
379 int totfracsame=0;
380 if (totnprocpaq_>0) totfracsame=100*totnpaqsamefc_/totnprocpaq_;
381 filog << ts << " : proc file (meanspectra) " << fname << endl;
382 filog << " NBlocProcessed=" << nblocproc_ << " NSameFC=" << totnpaqsamefc_ << " / " << totnprocpaq_
383 << " -> " << totfracsame << " % (LastPqs: " << npaqsamefc_ << " / " << nprocpaq_
384 << " -> " << fracsame << " % )" << endl;
385 cout << " MonitorProc::procData1C() " << ts << " : created file " << fname << endl;
386 cout << " NBlocProcessed=" << nblocproc_ << " NSameFC=" << totnpaqsamefc_ << " / " << totnprocpaq_
387 << " -> " << totfracsame << " % (LastPqs: " << npaqsamefc_ << " / " << nprocpaq_
388 << " -> " << fracsame << " % )" << endl;
389 }
390 return 0;
391}
392
393/* --Methode-- */
394int MonitorProc::procData2C(ofstream& filog)
395{
396 BRPaqChecker pcheck[MAXNBFIB]; // Verification/comptage des paquets
397// Initialisation pour calcul FFT
398 uint_4 paqsz = memgr.PaqSize();
399 BRPaquet pq(paqsz);
400 TVector<r_4> vx(pq.DataSize()/2);
401 vx = (r_4)(0.);
402 TVector< complex<r_4> > cfour(pq.DataSize()/4+1); // composant TF
403
404 fftwf_plan plan = fftwf_plan_dft_r2c_1d(vx.Size(), vx.Data(),
405 (fftwf_complex *)cfour.Data(), FFTW_ESTIMATE);
406
407 // Histo pour valeurs des bytes dans les paquets
408 Histo* phist[2*MAXNBFIB];
409 Histo2D* ph2[2*MAXNBFIB];
410 Histo* phexp[2*MAXNBFIB];
411 TMatrix<r_4>* psatur[2*MAXNBFIB];
412 TVector<uint_4>* pvsatfreq[2*MAXNBFIB];
413 for(int ifib=0; ifib<2*MAXNBFIB; ifib++) {
414 phist[ifib]=NULL; ph2[ifib]=NULL; phexp[ifib]=NULL; psatur[ifib]=NULL;
415 }
416 if (par_.fgdatafft) { // data de type FFT
417 for(sa_size_t lc=0; lc<2*memgr.NbFibres(); lc++) {
418 phist[lc] = new Histo(-128.5,+128.5,257);
419 ph2[lc] = new Histo2D(-128.5,+128.5,257, -128.5,+128.5,257);
420 phexp[lc] = new Histo(-128.5,+128.5,257);
421 psatur[lc] = new TMatrix<r_4>(3,3);
422 pvsatfreq[lc] = new TVector<uint_4>(spectre_.NCols());
423 *psatur[lc] = 0.;
424 }
425 }
426 else {
427 for(sa_size_t lc=0; lc<2*memgr.NbFibres(); lc++)
428 phist[lc] = new Histo(-0.5,256.5,257);
429 }
430
431 TimeStamp ts;
432 char fname[512];
433 nfiles_ = 0;
434 for (uint_4 kmz=0; kmz<nmax_; kmz++) {
435 if (stop_) break;
436 if (memgr.GetRunState() == MemZR_Stopped) break;
437
438 int mid = memgr.FindMemZoneId(mmact_); // MemZA_Proc
439 Byte* buffg = memgr.GetMemZone(mid);
440 if (buffg == NULL) {
441 cout << " MonitorProc::procData2C()/ERROR memgr.GetMemZone(" << mid << ") -> NULL" << endl;
442 break;
443 }
444 if ((step_>1)&&(kmz%step_ != 0)) {
445 memgr.FreeMemZone(mid, mmsta_); // MemZS_Proc);
446 continue;
447 }
448 sa_size_t lc=0;
449 Byte* fbuff[MAXNBFIB];
450 for(uint_4 fib=0; fib<memgr.NbFibres(); fib++) { // Boucle sur les fibres
451 fbuff[fib] = memgr.GetMemZone(mid,fib);
452 if (fbuff[fib] == NULL) { // cela ne devrait pas arriver
453 cout << " MonitorProc::procData2C()/ERROR memgr.GetMemZone(" << mid << "," << fib << ") -> NULL" << endl;
454 return 9;
455 }
456 }
457
458 // DBG-ATTENTION : freq 0 pour expo full FFT si reordonne
459 int idxexpo=(par_.fgfftshrink)?1023:0; // exposant FFT shrink 1024 freq, ou freq 0 pour full-FFT
460
461 cpaqok_ = (uint_1)0;
462 curfc_ = (uint_8)0;
463 for(uint_4 fib=0; fib<memgr.NbFibres(); fib++) {
464 for(uint_4 i=0; i<memgr.NbPaquets(); i++) {
465 BRPaquet paq(fbuff[fib]+i*paqsz, paqsz);
466 bool pqok=pcheck[fib].Check(paq,curfc_(fib,i)); // Verification du paquet / FrameCounter
467 if (!pqok) continue;
468 cpaqok_(fib,i) = 1;
469 sa_size_t lc=2*fib;
470 if (par_.fgdatafft) { // Traitement data de type FFT
471 TwoByteComplex* tbcp=paq.Data1C();
472
473 // exposant FFT
474 phexp[lc]->Add((r_4)tbcp[idxexpo].realD());
475
476 for(sa_size_t j=1; j<spectre_.NCols(); j++) {
477 phist[lc]->Add((r_4)tbcp[j].realD());
478 phist[lc]->Add((r_4)tbcp[j].imagD());
479 ph2[lc]->Add((r_4)tbcp[j].realD(), (r_4)tbcp[j].imagD());
480 // comptage saturation
481 int sir=0, sii=0; // saturation partie reelle, partie imaginaire
482 if (tbcp[j].realI()==-128) sir=-1;
483 else if (tbcp[j].realI()==127) sir=1;
484 if (tbcp[j].imagI()==-128) sii=-1;
485 else if (tbcp[j].imagI()==127) sii=1;
486 (*psatur[lc])(sir+1,sii+1)+=1.;
487 if ((sir!=0)||(sii!=0)) (*pvsatfreq[lc])(j)+=1;
488 spectre_(lc,j) += Zmod2(tbcp[j]);
489 }
490 nzm_[lc]++;
491 tbcp=paq.Data2C(); lc++;
492 phexp[lc]->Add((r_4)tbcp[idxexpo].realD());
493 for(sa_size_t j=1; j<spectre_.NCols(); j++) {
494 phist[lc]->Add((r_4)tbcp[j].realD());
495 phist[lc]->Add((r_4)tbcp[j].imagD());
496 ph2[lc]->Add((r_4)tbcp[j].realD(), (r_4)tbcp[j].imagD());
497 // comptage saturation
498 int sir=0, sii=0; // saturation partie reelle, partie imaginaire
499 if (tbcp[j].realI()==-128) sir=-1;
500 else if (tbcp[j].realI()==127) sir=1;
501 if (tbcp[j].imagI()==-128) sii=-1;
502 else if (tbcp[j].imagI()==127) sii=1;
503 (*psatur[lc])(sir+1,sii+1)+=1.;
504 if ((sir!=0)||(sii!=0)) (*pvsatfreq[lc])(j)+=1;
505
506 spectre_(lc,j) += Zmod2(tbcp[j]);
507 }
508 nzm_[lc]++;
509 }
510 else { // Traitement RawData
511 for(sa_size_t j=0; j<vx.Size(); j++) {
512 phist[lc]->Add((r_8)(*(paq.Data1()+j)));
513 vx(j) = (r_4)(*(paq.Data1()+j))-127.5;
514 }
515 fftwf_execute(plan);
516 // ffts_.FFTForward(vx, cfour_);
517 for(sa_size_t j=0; j<spectre_.NCols(); j++)
518 spectre_(lc,j) += Zmod2(cfour(j+1));
519 nzm_[lc]++; lc++;
520 for(sa_size_t j=0; j<vx.Size(); j++) {
521 phist[lc]->Add((r_8)(*(paq.Data2()+j)));
522 vx(j) = (r_4)(*(paq.Data2()+j))-127.5;
523 }
524 fftwf_execute(plan);
525 // ffts_.FFTForward(vx, cfour_);
526 for(sa_size_t j=0; j<spectre_.NCols(); j++)
527 spectre_(lc,j) += Zmod2(cfour(j+1));
528 nzm_[lc]++;
529 }
530 } // FIN de la boucle sur les paquets
531 } // Boucle sur les fibres
532 memgr.FreeMemZone(mid, mmsta_); // MemZS_Proc);
533 CheckFrameCounters();
534
535 nblocproc_ ++;
536 totnprocpaq_ += memgr.NbPaquets(); nprocpaq_ += memgr.NbPaquets();
537 bool fgnzm=true;
538 for(int lc=0; lc<2*memgr.NbFibres(); lc++)
539 if (nzm_[lc]<nmean_) fgnzm=false;
540
541 if (fgnzm) {
542 char buff[32];
543 for(sa_size_t lc=0; lc<2*memgr.NbFibres(); lc++) {
544 spectre_.Row(lc) /= (r_4)nzm_[lc];
545 sprintf(buff,"NPaqMoy%d",(int)lc);
546 spectre_.Info()[buff] = nzm_[lc];
547 }
548 sprintf(fname,"%s/meanspec%d.ppf",path_.c_str(),(int)nfiles_);
549 nfiles_++;
550 POutPersist po(fname);
551 po << PPFNameTag("spectre") << spectre_;
552 spectre_ = (r_4)(0.);
553 char buftag[32];
554 for(int lc=0; lc<2*memgr.NbFibres(); lc++) {
555 sprintf(buftag,"hvalV%d",(int)lc);
556 po << PPFNameTag(buftag) << (*phist[lc]);
557 phist[lc]->Zero();
558 if (par_.fgdatafft) { // data de type FFT
559 sprintf(buftag,"h2dV%d",(int)lc);
560 po << PPFNameTag(buftag) << (*ph2[lc]);
561 ph2[lc]->Zero();
562 sprintf(buftag,"hexpV%d",(int)lc);
563 po << PPFNameTag(buftag) << (*phexp[lc]);
564 phexp[lc]->Zero();
565 sprintf(buftag,"saturV%d",(int)lc);
566 po << PPFNameTag(buftag) << (*psatur[lc]);
567 (*psatur[lc])=0.;
568 sprintf(buftag,"satfreqV%d",(int)lc);
569 po << PPFNameTag(buftag) << (*pvsatfreq[lc]);
570 (*pvsatfreq[lc])=0;
571 }
572 nzm_[lc]=0;
573 }
574 ts.SetNow();
575 // Calcul / impression fraction des paquets avec same-framecounter
576 int fracsame=0;
577 if (nprocpaq_>0) fracsame=100*npaqsamefc_/nprocpaq_;
578 int totfracsame=0;
579 if (totnprocpaq_>0) totfracsame=100*totnpaqsamefc_/totnprocpaq_;
580 filog << ts << " : proc file (meanspectra) " << fname << endl;
581 filog << " NBlocProcessed=" << nblocproc_ << " NSameFC=" << totnpaqsamefc_ << " / " << totnprocpaq_
582 << " -> " << totfracsame << " % (LastPqs: " << npaqsamefc_ << " / " << nprocpaq_
583 << " -> " << fracsame << " % )" << endl;
584 cout << " MonitorProc::procData2C() " << ts << " : created file " << fname << endl;
585 cout << " NBlocProcessed=" << nblocproc_ << " NSameFC=" << totnpaqsamefc_ << " / " << totnprocpaq_
586 << " -> " << totfracsame << " % (LastPqs: " << npaqsamefc_ << " / " << nprocpaq_
587 << " -> " << fracsame << " % )" << endl;
588 nprocpaq_=npaqsamefc_=0;
589 }
590 } // Fin de boucle sur les kmz ( bloc MemZoneMgr a traiter )
591
592 bool fgnzm=false;
593 for(int lc=0; lc<2*memgr.NbFibres(); lc++)
594 if (nzm_[lc]>0) fgnzm=true;
595
596 if (fgnzm) {
597 char buff[32];
598 for(sa_size_t lc=0; lc<2*memgr.NbFibres(); lc++) {
599 if (nzm_[lc]>0) spectre_.Row(lc) /= (r_4)nzm_[lc];
600 sprintf(buff,"NPaqMoy%d",(int)lc);
601 spectre_.Info()[buff] = nzm_[lc];
602 }
603 sprintf(fname,"%s/meanspec%d.ppf",path_.c_str(),(int)nfiles_);
604 POutPersist po(fname);
605 po << PPFNameTag("spectre") << spectre_;
606 spectre_ = (r_4)(0.);
607 char buftag[32];
608 for(int lc=0; lc<2*memgr.NbFibres(); lc++) {
609 sprintf(buftag,"hvalV%d",(int)lc);
610 po << PPFNameTag(buftag) << (*phist[lc]);
611 delete phist[lc];
612 if (par_.fgdatafft) { // data de type FFT
613 sprintf(buftag,"h2dV%d",(int)lc);
614 po << PPFNameTag(buftag) << (*ph2[lc]);
615 delete ph2[lc];
616 sprintf(buftag,"hexpV%d",(int)lc);
617 po << PPFNameTag(buftag) << (*phexp[lc]);
618 delete phexp[lc];
619 sprintf(buftag,"saturV%d",(int)lc);
620 po << PPFNameTag(buftag) << (*psatur[lc]);
621 sprintf(buftag,"satfreqV%d",(int)lc);
622 po << PPFNameTag(buftag) << (*pvsatfreq[lc]);
623 delete psatur[lc];
624 delete pvsatfreq[lc];
625 }
626 nzm_[lc]=0;
627 }
628 ts.SetNow();
629 // Calcul / impression fraction des paquets avec same-framecounter
630 int fracsame=0;
631 if (nprocpaq_>0) fracsame=100*npaqsamefc_/nprocpaq_;
632 int totfracsame=0;
633 if (totnprocpaq_>0) totfracsame=100*totnpaqsamefc_/totnprocpaq_;
634 filog << ts << " : proc file (meanspectra) " << fname << endl;
635 filog << " NBlocProcessed=" << nblocproc_ << " NSameFC=" << totnpaqsamefc_ << " / " << totnprocpaq_
636 << " -> " << totfracsame << " % (LastPqs: " << npaqsamefc_ << " / " << nprocpaq_
637 << " -> " << fracsame << " % )" << endl;
638 cout << " MonitorProc::procData2C() " << ts << " : created file " << fname << endl;
639 cout << " NBlocProcessed=" << nblocproc_ << " NSameFC=" << totnpaqsamefc_ << " / " << totnprocpaq_
640 << " -> " << totfracsame << " % (LastPqs: " << npaqsamefc_ << " / " << nprocpaq_
641 << " -> " << fracsame << " % )" << endl;
642 }
643 return 0;
644}
645
646/* --Methode-- */
647int MonitorProc::CheckFrameCounters()
648{
649 if (memgr.NbFibres()<2) {
650 npaqsamefc_++; totnpaqsamefc_++;
651 return 99;
652 }
653 sa_size_t pidx[MAXNBFIB];
654 sa_size_t maxidx=curfc_.NCols();
655 uint_8 cfc=0;
656 for(uint_4 fib=0; fib<curfc_.NRows(); fib++) {
657 pidx[fib]=0;
658 while((pidx[fib]<maxidx)&&(cpaqok_(fib,pidx[fib])==0)) pidx[fib]++;
659 }
660
661 bool fgsuite=true;
662 while (fgsuite) { // Boucle sur l'ensemble des paquets
663 for(uint_4 fib=0; fib<curfc_.NRows(); fib++) {
664 if ((pidx[fib]>=maxidx)||(cpaqok_(fib,pidx[fib])==0)) { fgsuite=false; break; }
665 }
666 if (!fgsuite) break;
667 cfc=curfc_(0,pidx[0]);
668 bool fgsame=true;
669 for(uint_4 fib=1; fib<curfc_.NRows(); fib++) {
670 if (curfc_(fib,pidx[fib])!=cfc) {
671 fgsame=false;
672 if (curfc_(fib,pidx[fib]) > cfc) cfc=curfc_(fib,pidx[fib]);
673 }
674 }
675 if (fgsame) {
676 npaqsamefc_++; totnpaqsamefc_++;
677 for(uint_4 fib=0; fib<curfc_.NRows(); fib++) {
678 pidx[fib]++;
679 while((pidx[fib]<maxidx)&&(cpaqok_(fib,pidx[fib])==0)) pidx[fib]++;
680 }
681 } // fin if (fgsame)
682 else { // else !fgsame
683 for(uint_4 fib=0; fib<memgr.NbFibres(); fib++) {
684 if (curfc_(fib,pidx[fib])<cfc) {
685 pidx[fib]++;
686 while((pidx[fib]<maxidx)&&(cpaqok_(fib,pidx[fib])==0)) pidx[fib]++;
687 }
688 }
689 } // fin de else !fgsame
690 } // Fin de while sur l'ensemble des paquets
691 return 0;
692}
693
694
695static struct sigaction act;
696//-------------------------------------------------------
697// Classe thread de traitement avec 1 voie par frame
698//-------------------------------------------------------
699/*!
700 \class DataProc
701 \ingroup TAcq
702
703 \brief Deprecated monitoring class (replaced by MonitorProc)
704*/
705
706void DataProcSignal(int s)
707{
708 cout <<"............................................... receive CtrlC" << endl;
709
710}
711
712DataProc::DataProc(RAcqMemZoneMgr& mem, string& path, uint_4 nmean, uint_4 step, uint_4 nmax)
713 : memgr(mem)
714{
715 nmax_ = nmax;
716 nmean_ = nmean;
717 step_ = step;
718 stop_ = false;
719 path_ = path;
720 act.sa_handler=DataProcSignal;
721}
722
723
724void DataProc::Stop()
725{
726 stop_=true;
727 // cout <<" DataProc::Stop ... > STOP " << endl;
728}
729
730void DataProc::run()
731{
732
733 // sigaddset(&act.sa_mask,SIGINT); // pour proteger le transfert DMA
734 // sigaction(SIGINT,&act,NULL);
735 setRC(1);
736 try {
737 TimeStamp ts;
738 cout << " DataProc::run() - Starting " << ts << " NMaxMemZones=" << nmax_
739 << " NMean=" << nmean_ << " Step=" << step_ << endl;
740 cout << " DataProc::run()... - Output Data Path: " << path_ << endl;
741 char fname[512];
742 sprintf(fname,"%s/proc.log",path_.c_str());
743 ofstream filog(fname);
744 filog << " DataProc::run() - starting log file " << ts << endl;
745 filog << " ... NMaxMemZones=" << nmax_ << " NMean=" << nmean_ << " Step=" << step_ << endl;
746
747// Initialisation pour clcul FFT
748 TVector< complex<r_4> > cfour; // composant TF
749 uint_4 paqsz = memgr.PaqSize();
750 BRPaquet pq(NULL, NULL, paqsz);
751 TVector<r_4> vx(pq.DataSize());
752 vx = (r_4)(0.);
753 FFTPackServer ffts;
754 ffts.FFTForward(vx, cfour);
755 TVector<r_4> spectre;
756 spectre.ReSize(cfour.Size());
757
758 fftwf_plan plan = fftwf_plan_dft_r2c_1d(vx.Size(), vx.Data(),
759 (fftwf_complex *)cfour.Data(), FFTW_ESTIMATE);
760
761 uint_4 ifile = 0;
762 uint_4 nzm = 0;
763 for (uint_4 kmz=0; kmz<nmax_; kmz++) {
764 if (stop_) break;
765 int mid = memgr.FindMemZoneId(MemZA_Proc);
766 Byte* buff = memgr.GetMemZone(mid);
767 if (buff == NULL) {
768 cout << " DataProc::run()/ERROR memgr.GetMemZone(" << mid << ") -> NULL" << endl;
769 setRC(2);
770 return;
771 }
772 BRPaquet paq0(NULL, buff, paqsz);
773 for(uint_4 i=0; i<memgr.NbPaquets(); i+=step_) {
774 BRPaquet paq(NULL, buff+i*paqsz, paqsz);
775 Byte min = 255;
776 Byte max = 0;
777
778 for(sa_size_t j=0; j<vx.Size(); j++)
779 vx(j) = (r_4)(*(paq.Data1()+j))-127.5;
780 fftwf_execute(plan);
781 // ffts_.FFTForward(vx, cfour_);
782 for(sa_size_t j=0; j<spectre.Size(); j++)
783 spectre(j) += Zmod2(cfour(j));
784 nzm++;
785 }
786 if ((nzm >= nmean_) ||(kmz==(nmax_-1))) {
787 spectre /= (r_4)(nzm);
788 spectre.Info()["NPaqMoy"] = nzm;
789 sprintf(fname,"%s/spectre%d.ppf",path_.c_str(),(int)ifile);
790 POutPersist po(fname);
791 po << spectre;
792 spectre = (r_4)(0.);
793 nzm = 0; ifile++;
794 ts.SetNow();
795 filog << ts << " : proc file " << fname << endl;
796 cout << " DataProc::run() " << ts << " : created file " << fname << endl;
797 }
798
799 memgr.FreeMemZone(mid, MemZS_Proc);
800 }
801 }
802 catch (std::exception& exc) {
803 cout << " DataProc::run()/catched std::exception " << exc.what() << endl;
804 setRC(3);
805 return;
806 }
807 catch(...) {
808 cout << " DataProc::run()/catched unknown ... exception " << endl;
809 setRC(4);
810 return;
811 }
812 setRC(0);
813 return;
814}
815
816//---------------------------------------------------------------
817// Classe thread de traitement donnees ADC avec 2 voies par frame
818//---------------------------------------------------------------
819
820/*!
821 \class DataProc2C
822 \ingroup TAcq
823
824 \brief Deprecated monitoring class (replaced by MonitorProc)
825*/
826
827DataProc2C::DataProc2C(RAcqMemZoneMgr& mem, string& path, uint_4 nmean, uint_4 step, uint_4 nmax)
828 : memgr(mem)
829{
830 nmax_ = nmax;
831 nmean_ = nmean;
832 step_ = step;
833 stop_ = false;
834 path_ = path;
835 act.sa_handler=DataProcSignal;
836}
837void DataProc2C::Stop()
838{
839 stop_=true;
840 // cout <<" DataProc2C::Stop ... > STOP " << endl;
841}
842
843void DataProc2C::run()
844{
845 // sigaction(SIGINT,&act,NULL);
846 setRC(1);
847 try {
848 TimeStamp ts;
849 cout << " DataProc2C::run() - Starting " << ts << " NMaxMemZones=" << nmax_
850 << " NMean=" << nmean_ << " Step=" << step_ << endl;
851 cout << " DataProc::run()... - Output Data Path: " << path_ << endl;
852 char fname[512];
853 sprintf(fname,"%s/proc.log",path_.c_str());
854 ofstream filog(fname);
855 filog << " DataProc2C::run() - starting log file " << ts << endl;
856 filog << " ... NMaxMemZones=" << nmax_ << " NMean=" << nmean_ << " Step=" << step_ << endl;
857
858// Initialisation pour clcul FFT
859 TVector< complex<r_4> > cfour; // composant TF
860 uint_4 paqsz = memgr.PaqSize();
861 BRPaquet pq(NULL, NULL, paqsz);
862 TVector<r_4> vx(pq.DataSize()/2);
863 vx = (r_4)(0.);
864 FFTPackServer ffts;
865 ffts.FFTForward(vx, cfour);
866 TVector<r_4> spectreV1, spectreV2;
867 spectreV1.ReSize(cfour.Size());
868 spectreV2.ReSize(cfour.Size());
869
870 fftwf_plan plan = fftwf_plan_dft_r2c_1d(vx.Size(), vx.Data(),
871 (fftwf_complex *)cfour.Data(), FFTW_ESTIMATE);
872
873 uint_4 ifile = 0;
874 uint_4 nzm = 0;
875 for (uint_4 kmz=0; kmz<nmax_; kmz++) {
876 if (stop_) break;
877 int mid = memgr.FindMemZoneId(MemZA_Proc);
878 Byte* buff = memgr.GetMemZone(mid);
879 if (buff == NULL) {
880 cout << " DataProc2C::run()/ERROR memgr.GetMemZone(" << mid << ") -> NULL" << endl;
881 setRC(2);
882 return;
883 }
884 BRPaquet paq0(NULL, buff, paqsz);
885 for(uint_4 i=0; i<memgr.NbPaquets(); i+=step_) {
886 BRPaquet paq(NULL, buff+i*paqsz, paqsz);
887 Byte min = 255;
888 Byte max = 0;
889
890 for(sa_size_t j=0; j<vx.Size(); j++)
891 vx(j) = (r_4)(*(paq.Data1()+j))-127.5;
892 fftwf_execute(plan);
893 // ffts_.FFTForward(vx, cfour_);
894 for(sa_size_t j=0; j<spectreV1.Size(); j++)
895 spectreV1(j) += Zmod2(cfour(j));
896
897 for(sa_size_t j=0; j<vx.Size(); j++)
898 vx(j) = (r_4)(*(paq.Data2()+j))-127.5;
899 fftwf_execute(plan);
900 // ffts_.FFTForward(vx, cfour_);
901 for(sa_size_t j=0; j<spectreV2.Size(); j++)
902 spectreV2(j) += Zmod2(cfour(j));
903
904 nzm++;
905 }
906 if ((nzm >= nmean_) ||(kmz==(nmax_-1))) {
907 spectreV1 /= (r_4)(nzm);
908 spectreV2 /= (r_4)(nzm);
909 spectreV1.Info()["NPaqMoy"] = nzm;
910 spectreV2.Info()["NPaqMoy"] = nzm;
911 {
912 sprintf(fname,"%s/spectre2C_%d.ppf",path_.c_str(),(int)ifile);
913 POutPersist po(fname);
914 po << PPFNameTag("specV1") << spectreV1;
915 po << PPFNameTag("specV2") << spectreV2;
916 }
917 spectreV1 = (r_4)(0.);
918 spectreV2 = (r_4)(0.);
919 nzm = 0; ifile++;
920 ts.SetNow();
921 filog << ts << " : proc file " << fname << endl;
922 cout << " DataProc2C::run() " << ts << " : created file " << fname << endl;
923 }
924
925 memgr.FreeMemZone(mid, MemZS_Proc);
926 }
927 }
928 catch (std::exception& exc) {
929 cout << " DataProc::run()/catched std::exception " << exc.what() << endl;
930 setRC(3);
931 return;
932 }
933 catch(...) {
934 cout << " DataProc2C::run()/catched unknown ... exception " << endl;
935 setRC(4);
936 return;
937 }
938 setRC(0);
939 return;
940}
941
942
943
944
945//---------------------------------------------------------------
946// Classe thread de traitement donnees FFT avec 2 voies par frame
947//---------------------------------------------------------------
948/*!
949 \class DataProcFFT2C
950 \ingroup TAcq
951
952 \brief Deprecated monitoring class (replaced by MonitorProc)
953*/
954
955inline r_4 Zmod2TwoByte(TwoByteComplex z)
956{ return (z.realD()*z.realD()+z.imagD()*z.imagD()); }
957
958DataProcFFT2C::DataProcFFT2C(RAcqMemZoneMgr& mem, string& path, uint_4 nmean, uint_4 step, uint_4 nmax)
959 : memgr(mem)
960{
961 nmax_ = nmax;
962 nmean_ = nmean;
963 step_ = step;
964 stop_ = false;
965 path_ = path;
966 act.sa_handler=DataProcSignal;
967}
968void DataProcFFT2C::Stop()
969{
970 stop_=true;
971 // cout <<" DataProcFFT2C::Stop ... > STOP " << endl;
972}
973
974void DataProcFFT2C::run()
975{
976 // sigaction(SIGINT,&act,NULL);
977 setRC(1);
978 try {
979 TimeStamp ts;
980 cout << " DataProcFFT2C::run() - Starting " << ts << " NMaxMemZones=" << nmax_
981 << " NMean=" << nmean_ << " Step=" << step_ << endl;
982 cout << " DataProc::run()... - Output Data Path: " << path_ << endl;
983 char fname[512];
984 sprintf(fname,"%s/proc.log",path_.c_str());
985 ofstream filog(fname);
986 filog << " DataProcFFT2C::run() - starting log file " << ts << endl;
987 filog << " ... NMaxMemZones=" << nmax_ << " NMean=" << nmean_ << " Step=" << step_ << endl;
988
989// Initialisation pour clcul FFT
990 TVector< complex<r_4> > cfour; // composant TF
991 uint_4 paqsz = memgr.PaqSize();
992 BRPaquet pq(NULL, NULL, paqsz);
993
994 TVector<r_4> spectreV1(pq.DataSize()/4+1), spectreV2(pq.DataSize()/4+1);
995
996 uint_4 ifile = 0;
997 for (uint_4 kmz=0; kmz<nmax_; kmz++) {
998 if (stop_ ) break;
999 int mid = memgr.FindMemZoneId(MemZA_Proc);
1000 Byte* buff = memgr.GetMemZone(mid);
1001 if (buff == NULL) {
1002 cout << " DataProcFFT2C::run()/ERROR memgr.GetMemZone(" << mid << ") -> NULL" << endl;
1003 setRC(2);
1004 return;
1005 }
1006 BRPaquet paq0(NULL, buff, paqsz);
1007 uint_4 nzm = 0;
1008 for(uint_4 i=0; i<memgr.NbPaquets(); i+=step_) {
1009 BRPaquet paq(NULL, buff+i*paqsz, paqsz);
1010 Byte min = 255;
1011 Byte max = 0;
1012
1013 TwoByteComplex* zz;
1014 // Traitement Voie 1
1015 zz = (TwoByteComplex*)paq.Data1();
1016 spectreV1(0) += zz[0].realD()*zz[0].realD(); // Composante continue, partie reelle uniquement
1017 for(sa_size_t j=1; j<spectreV1.Size()-1; j++) spectreV1(j) += Zmod2TwoByte(zz[j]);
1018
1019 spectreV1(spectreV1.Size()-1) += zz[0].imagD()*zz[0].imagD(); // Freq. Nyquist a N/2
1020
1021 // Traitement Voie 2
1022 zz = (TwoByteComplex*)paq.Data2();
1023 spectreV2(0) += zz[0].realD()*zz[0].realD(); // Composante continue, partie reelle uniquement
1024 for(sa_size_t j=1; j<spectreV2.Size()-1; j++) spectreV2(j) += Zmod2TwoByte(zz[j]);
1025
1026 spectreV2(spectreV2.Size()-1) += zz[0].imagD()*zz[0].imagD(); // Freq. Nyquist a N/2
1027
1028 nzm++;
1029 }
1030 if ((nzm >= nmean_) ||(kmz==(nmax_-1))) {
1031 spectreV1 /= (r_4)(nzm);
1032 spectreV2 /= (r_4)(nzm);
1033 spectreV1.Info()["NPaqMoy"] = nzm;
1034 spectreV2.Info()["NPaqMoy"] = nzm;
1035 {
1036 sprintf(fname,"%s/spectreFFT2C_%d.ppf",path_.c_str(),(int)ifile);
1037 POutPersist po(fname);
1038 po << PPFNameTag("specV1") << spectreV1;
1039 po << PPFNameTag("specV2") << spectreV2;
1040 }
1041 spectreV1 = (r_4)(0.);
1042 spectreV2 = (r_4)(0.);
1043 nzm = 0; ifile++;
1044 ts.SetNow();
1045 filog << ts << " : proc file " << fname << endl;
1046 cout << " DataProcFFT2C::run() " << ts << " : created file " << fname << endl;
1047 }
1048
1049 memgr.FreeMemZone(mid, MemZS_Proc);
1050 }
1051 }
1052 catch (std::exception& exc) {
1053 cout << " DataProc::run()/catched std::exception " << exc.what() << endl;
1054 setRC(3);
1055 return;
1056 }
1057 catch(...) {
1058 cout << " DataProcFFT2C::run()/catched unknown ... exception " << endl;
1059 setRC(4);
1060 return;
1061 }
1062 setRC(0);
1063 return;
1064}
Note: See TracBrowser for help on using the repository browser.