source: Sophya/trunk/AddOn/TAcq/brproc.cc@ 3705

Last change on this file since 3705 was 3705, checked in by ansari, 16 years ago

Ajout possibilite verification timetag, Reza 9/12/2009
File size: 31.2 KB
Line 
1#include "racquproc.h"
2
3#include <stdlib.h>
4#include <string.h>
5#include <unistd.h>
6#include <fstream>
7#include <signal.h>
8
9#include "pexceptions.h"
10#include "tvector.h"
11#include "ntuple.h"
12#include "datatable.h"
13#include "histos.h"
14#include "fioarr.h"
15#include "matharr.h"
16#include "timestamp.h"
17#include "ctimer.h"
18#include "fftpserver.h"
19#include "fftwserver.h"
20
21#include "FFTW/fftw3.h"
22
23
24#include "pciewrap.h"
25#include "brpaqu.h"
26#include "brproc.h"
27
28//---------------------------------------------------------------------
29// Classe de traitement - calcul de visibilite pour n fibres
30//---------------------------------------------------------------------
31
32/* --Methode-- */
33BRVisibilityCalculator::BRVisibilityCalculator(RAcqMemZoneMgr& memgr, string outpath, uint_4 nmean,
34 uint_4 freq1, uint_4 freq2, uint_4 nbfreq)
35 : BRBaseProcessor(memgr), outpath_(outpath), nmean_(nmean), numfreq1_(freq1), numfreq2_(freq2), nbinfreq_(nbfreq),
36 vpdata_(2*memgr.NbFibres())
37 // , dtfos_(outpath+"visdt.fits", Fits_Create), visdt_(dtfos_, 1024, true);
38
39{
40 BRPaquet paq(memgr_.PaqSize());
41
42 vismtx_.SetSize((2*memgr_.NbFibres()+1)*memgr_.NbFibres(), paq.DataSize()/4);
43 chanum_.SetSize(vismtx_.NRows());
44 sa_size_t k=0;
45 for(size_t i=0; i<2*memgr_.NbFibres(); i++) vpdata_[i]=NULL;
46 for(size_t i=0; i<2*memgr_.NbFibres(); i++) {
47 for(size_t j=i; j<2*memgr_.NbFibres(); j++) {
48 chanum_(k) = (i+1)*100+(j+1); k++;
49 }
50 }
51 // visdt_.AddFloatColumn("mfc");
52 visdt_.AddDoubleColumn("mfc");
53 visdt_.AddDoubleColumn("mtt");
54 visdt_.AddIntegerColumn("jfreq");
55 visdt_.AddIntegerColumn("numch");
56 visdt_.AddFloatColumn("vre");
57 visdt_.AddFloatColumn("vim");
58
59 if (nmean_ < 1) nmean_=memgr_.NbPaquets();
60 if (nmean_ < 1) nmean_=1;
61
62 totnbpaq_=0;
63 numfile_=0;
64 moyfc_=moytt_=0.;
65
66 jf1_=numfreq1_; jf2_=numfreq2_;
67 if ((jf1_<1)||(jf1_>=vismtx_.NCols())) jf1_=1;
68 if ((jf2_<1)||(jf2_>=vismtx_.NCols())||(jf2_<jf1_)) jf2_=vismtx_.NCols()-1;
69 if (nbinfreq_<1) nbinfreq_=1;
70 djf_=(jf2_-jf1_)/nbinfreq_;
71 if (djf_<1) djf_=0;
72 xnt_ = new double[vismtx_.NRows()+20];
73 for(int kk=0; kk<vismtx_.NRows(); kk++) xnt_[kk]=0.;
74
75 cout << " BRVisibilityCalculator/Info NMean= " << nmean_ << " JF1=" << jf1_
76 << " JF2=" << jf2_ << " DJF=" << djf_ << endl;
77
78 fgcktt_=false;
79}
80
81/* --Methode-- */
82BRVisibilityCalculator::~BRVisibilityCalculator()
83{
84 cout << " BRVisibilityCalculator - Visibility Datatable : " << endl;
85 cout << visdt_;
86 POutPersist po(outpath_+"visdt.ppf");
87 po << visdt_;
88 POutPersist poc(outpath_+"chanum.ppf");
89 poc << chanum_;
90
91 if (fgcktt_) {
92 cout << " BRVisibilityCalculator - Check TimeTag done: " << endl;
93 for(size_t fib=0; fib<(size_t)memgr_.NbFibres(); fib++) {
94 cout << " BRTTCheck-Fiber[" << fib << "] NBadTT=" << vbadtt_[fib]
95 << " NotSameTT=" << vnsamett_[fib] << endl;
96 }
97 POutPersist pott(outpath_+"ttfcmtx.ppf");
98 pott << PPFNameTag("FC") << fcmtx_;
99 pott << PPFNameTag("TT") << ttmtx_;
100 }
101 delete[] xnt_;
102}
103
104/* --Methode-- */
105int BRVisibilityCalculator::ActivateTimeTagCheck(uint_8 maxnpaq)
106{
107 cout << " BRVisibilityCalculator::ActivateTimeTagCheck() - TT/Fc matrix NCols=" << maxnpaq << endl;
108 mindeltatt_=memgr_.PaqSize()/2;
109 if (mindeltatt_<1) mindeltatt_=1;
110 fcmtx_.SetSize(memgr_.NbFibres(), maxnpaq);
111 ttmtx_.SetSize(memgr_.NbFibres(), maxnpaq);
112 vlasttt_.resize(memgr_.NbFibres(), 0);
113 vbadtt_.resize(memgr_.NbFibres(), 0);
114 vnsamett_.resize(memgr_.NbFibres(), 0);
115 fgcktt_=true;
116 return 0;
117}
118
119/* --Methode-- */
120int BRVisibilityCalculator::Process()
121{
122
123 for(size_t fib=0; fib<(size_t)memgr_.NbFibres(); fib++) {
124 vpdata_[2*fib] = vpaq_[fib].Data1C();
125 vpdata_[2*fib+1] = vpaq_[fib].Data2C();
126 }
127
128 if (totnbpaq_%nmean_ == 0) {
129 if (totnbpaq_ > 0) {
130 moyfc_/=nmean_;
131 moytt_/=nmean_;
132 vismtx_.Info()["MeanFC"] = moyfc_;
133 vismtx_.Info()["MeanTT"] = moytt_;
134 vismtx_.Info()["NPAQSUM"] = nmean_;
135
136 // ATTENTION : Matrice visibilites non moyennee
137 char nfile[32];
138 sprintf(nfile,"vismtx%d.ppf",numfile_);
139 string flnm=outpath_+nfile;
140 POutPersist po(flnm);
141 po << vismtx_;
142 cout << numfile_ << "-BRVisibilityCalculator::Process() NPaqProc="
143 << totnbpaq_ << " -> Visibility Matrix in " << flnm << endl;
144 FillVisibTable(moyfc_, moytt_);
145 numfile_++;
146 }
147 vismtx_ = complex<r_4>((r_4)0.,(r_4)0.);
148 moyfc_=moytt_=0.;
149 }
150
151 sa_size_t k=0;
152 for(size_t i=0; i<vpdata_.size(); i++) {
153 for(size_t j=i; j<vpdata_.size(); j++) {
154 TVector< complex<r_4> > vis = vismtx_.Row(k); k++;
155 for(sa_size_t f=1; f<vis.Size(); f++) {
156 vis(f) += complex<r_4>((r_4)vpdata_[i][f].realB(), (r_4)vpdata_[i][f].imagB()) *
157 complex<r_4>((r_4)vpdata_[j][f].realB(), -(r_4)vpdata_[j][f].imagB());
158 }
159 }
160 }
161
162 moyfc_ += curfc_[0];
163 moytt_ += (vpaq_[0].TimeTag()-ttfirst_[0]);
164 if (fgcktt_) CheckTimeTag();
165 totnbpaq_++;
166 return 0;
167}
168
169/* --Methode-- */
170int BRVisibilityCalculator::FillVisibTable(double fcm, double ttm)
171{
172 xnt_[0]=fcm; xnt_[1]=ttm/1.25e8;
173
174 if (djf_<2) {
175 for(sa_size_t rv=0; rv<vismtx_.NRows(); rv++) {
176 for(sa_size_t jf=jf1_; jf<jf2_; jf++) {
177 xnt_[2]=jf;
178 xnt_[3]=chanum_(rv);
179 xnt_[4]=vismtx_(rv,jf).real()/(r_4)(nmean_);
180 xnt_[5]=vismtx_(rv,jf).imag()/(r_4)(nmean_);
181 visdt_.AddRow(xnt_);
182 }
183 }
184 }
185 else {
186 for(sa_size_t rv=0; rv<vismtx_.NRows(); rv++) {
187 for(sa_size_t jf=jf1_; jf<jf2_; jf+=djf_) {
188 r_4 moyreal=0.;
189 r_4 moyimag=0.;
190 sa_size_t jjfmx=jf+djf_;
191 if (jjfmx > vismtx_.NCols()) jjfmx=vismtx_.NCols();
192 for(sa_size_t jjf=jf; jjf<jjfmx; jjf++) {
193 moyreal+=vismtx_(rv,jjf).real();
194 moyimag+=vismtx_(rv,jjf).imag();
195 }
196 xnt_[2]=jf+djf_/2;
197 xnt_[3]=chanum_(rv);
198 xnt_[4]=moyreal/(r_4)(nmean_*djf_);
199 xnt_[5]=moyimag/(r_4)(nmean_*djf_);
200 visdt_.AddRow(xnt_);
201 }
202 }
203 }
204 return 0;
205}
206
207/* --Methode-- */
208int BRVisibilityCalculator::CheckTimeTag()
209{
210 if (totnbpaq_==0) {
211 for(size_t fib=0; fib<(size_t)memgr_.NbFibres(); fib++) {
212 vlasttt_[fib]=ttfirst_[fib];
213 if (ttmtx_.NCols()>0) {
214 fcmtx_(fib,totnbpaq_) = curfc_[fib];
215 ttmtx_(fib,totnbpaq_) = vlasttt_[fib];
216 }
217 }
218 return 0;
219 }
220 for(size_t fib=0; fib<(size_t)memgr_.NbFibres(); fib++) {
221 uint_8 ld = vpaq_[fib].TimeTag()-vlasttt_[fib];
222 uint_8 fd = vpaq_[fib].TimeTag()-ttfirst_[fib]-vpaq_[0].TimeTag()+ttfirst_[0];
223 if ( (ld < mindeltatt_) || (fd<-5) || (fd>5)) { vbadtt_[fib]++; vnsamett_[fib]++; }
224 else {
225 if (fd!=0) vnsamett_[fib]++;
226 }
227 vlasttt_[fib]=vpaq_[fib].TimeTag();
228 if (totnbpaq_<ttmtx_.NCols()) {
229 fcmtx_(fib,totnbpaq_) = curfc_[fib];
230 ttmtx_(fib,totnbpaq_) = vlasttt_[fib];
231 }
232 }
233 return 0;
234}
235
236//---------------------------------------------------------------
237// Classe thread de traitement donnees ADC avec 2 voies par frame
238//---------------------------------------------------------------
239
240// Mutex pour eviter le plantage du a FFTW qui ne semble pas thread-safe
241static ZMutex* pmutfftw=NULL;
242
243/* --Methode-- */
244BRProcA2C::BRProcA2C(RAcqMemZoneMgr& mem, string& path, bool fgraw, uint_4 nmean,
245 uint_4 nmax, bool fghist, uint_4 nfsmap, bool fgnotrl, int card)
246 : memgr(mem)
247{
248 fgraw_ = fgraw;
249 nmax_ = nmax;
250 nmean_ = nmean;
251 if (fgraw_) cout << " BRProcA2C::BRProcA2C() - constructeur RAW data - NMean=" << nmean_ << endl;
252 else cout << " BRProcA2C::BRProcA2C() - constructeur FFT data - NMean=" << nmean_ << endl;
253 nfsmap_ = nfsmap;
254 stop_ = false;
255 path_ = path;
256 fgnotrl_ = fgnotrl;
257 fghist_ = fghist;
258 card_ = card;
259 if (pmutfftw==NULL) pmutfftw=new ZMutex;
260}
261
262/* --Methode-- */
263void BRProcA2C::Stop()
264{
265 stop_=true;
266 // cout <<" BRProcA2C::Stop ... > STOP " << endl;
267}
268
269
270static inline r_4 Zmod2(complex<r_4> z)
271{ return (z.real()*z.real()+z.imag()*z.imag()); }
272
273static inline string card2name_(int card)
274{
275 if (card==2) return " (Chan3,4) ";
276 else return " (Chan1,2) ";
277}
278/* --Methode-- */
279void BRProcA2C::run()
280{
281 setRC(1);
282 try {
283 Timer tm("BRProcA2C", false);
284 TimeStamp ts;
285 BRPaqChecker pcheck(!fgnotrl_); // Verification/comptage des paquets
286
287 size_t totnbytesout = 0;
288 size_t totnbytesproc = 0;
289
290 cout << " BRProcA2C::run() - Starting " << ts << " NMaxMemZones=" << nmax_
291 << " NMean=" << nmean_ << card2name_(card_) << endl;
292 cout << " BRProcA2C::run()... - Output Data Path: " << path_ << endl;
293 char fname[512];
294// sprintf(fname,"%s/proc.log",path_.c_str());
295// ofstream filog(fname);
296// filog << " BRProcA2C::run() - starting log file " << ts << endl;
297// filog << " ... NMaxMemZones=" << nmax_ << " NMean=" << nmean_ << " Step=" << step_ << endl;
298
299/*----DELETE NTuple
300 const char* nnames[8] = {"fcs","tts","s1","s2","s12","s12re","s12im","s12phi"};
301 NTuple nt(8, nnames);
302 double xnt[10];
303 uint_4 nmnt = 0;
304 double ms1,ms2,ms12,ms12re,ms12im,ms12phi;
305----*/
306// Time sample (raw data) /FFT coeff histograms
307 Histo* ph1=NULL;
308 Histo* ph2=NULL;
309 if (fghist_) {
310 if (fgraw_) {
311 ph1 = new Histo(-0.5, 255.5, 256);
312 ph2 = new Histo(-0.5, 255.5, 256);
313 }
314 else {
315 ph1 = new Histo(-128.5, 128.5, 257);
316 ph2 = new Histo(-128.5, 128.5, 257);
317 }
318 }
319
320// Initialisation pour calcul FFT
321 TVector< complex<r_4> > cfour1; // composant TF
322 uint_4 paqsz = memgr.PaqSize();
323 uint_4 procpaqsz = memgr.ProcPaqSize();
324
325
326 BRPaquet pq(NULL, NULL, paqsz);
327 TVector<r_4> vx(pq.DataSize()/2);
328 int szfour = pq.DataSize()/2/2+1;
329 cfour1.SetSize(szfour);
330/*
331 vx = (r_4)(0.);
332 FFTPackServer ffts;
333 ffts.FFTForward(vx, cfour1);
334 szfour = cfour1.Size();
335*/
336
337 bool fgtimfreq = false; // true->cartes temps<>frequences
338 if (nfsmap_>0) fgtimfreq=true;
339
340 TVector< complex<r_4> > cfour2(cfour1.Size());
341
342 TVector<r_4> spectreV1(cfour1.Size());
343 TVector<r_4> spectreV2(cfour1.Size());
344 TVector<r_4> moyspecV1(cfour1.Size()); // Moyenne des Spectres
345 TVector<r_4> moyspecV2(cfour1.Size());
346 TVector<r_4> sigspecV1(cfour1.Size()); // Sigma des Spectres
347 TVector<r_4> sigspecV2(cfour1.Size());
348 TVector< complex<r_4> > visiV12( cfour1.Size() );
349
350 TMatrix<r_4> timfreqV1, timfreqV2; // Cartes temps<>frequences
351 if (fgtimfreq) {
352 timfreqV1.SetSize(nmean_, spectreV1.Size()/nfsmap_);
353 timfreqV2.SetSize(nmean_, spectreV2.Size()/nfsmap_);
354 }
355 cout << " *DBG*BRProcA2C PaqSz=" << paqsz << " ProcPaqSize=" << procpaqsz
356 << " procpaqsz/2=" << procpaqsz/2 << " cfour1.Size()=" << cfour1.Size()
357 << " *8=" << cfour1.Size()*8 << endl;
358
359 pmutfftw->lock();
360 fftwf_plan plan1 = fftwf_plan_dft_r2c_1d(vx.Size(), vx.Data(),
361 (fftwf_complex*)cfour1.Data(), FFTW_ESTIMATE);
362 fftwf_plan plan2 = fftwf_plan_dft_r2c_1d(vx.Size(), vx.Data(),
363 (fftwf_complex*)cfour2.Data(), FFTW_ESTIMATE);
364 pmutfftw->unlock();
365
366 uint_4 ifile = 0;
367 uint_4 nzm = 0; // Nb de paquets moyennes pour le calcul de chaque spectre
368 uint_4 nmoyspec = 0; // Nb de spectres moyennes
369
370 uint_4 curfc=0;
371 uint_8 curtt=0;
372 uint_8 firsttt=0;
373 bool fgfirst=true;
374 double moysig[2]={0.,0.};
375 double sigsig[2]={0.,0.};
376 uint_8 nbsig[2]={0,0};
377
378 for (uint_4 kmz=0; kmz<nmax_; kmz++) {
379 if (stop_) break;
380 int mid = memgr.FindMemZoneId(MemZA_ProcA);
381 Byte* buff = memgr.GetMemZone(mid);
382 if (buff == NULL) {
383 cout << " BRProcA2C::run()/ERROR memgr.GetMemZone(" << mid << ") -> NULL" << endl;
384 break;
385 }
386 Byte* procbuff = memgr.GetProcMemZone(mid);
387 if (procbuff == NULL) {
388 cout << " BRProcA2C::run()/ERROR memgr.GetProcMemZone(" << mid << ") -> NULL" << endl;
389 break;
390 }
391//---- DELETE nmnt=0; ms1=ms2=ms12=ms12re=ms12im=ms12phi=0.;
392 for(uint_4 i=0; i<memgr.NbPaquets(); i++) {
393 BRPaquet paq(NULL, buff+i*paqsz, paqsz);
394 if (!pcheck.Check(paq)) continue; // on ne traite que les paquets OK
395 if (fgfirst) { firsttt=paq.TimeTag(); fgfirst=false; }
396 curfc=paq.FrameCounter();
397 curtt=paq.TimeTag()-firsttt;
398// Traitement voie 1
399 if (fghist_) {
400 for(sa_size_t j=0; j<vx.Size(); j++) {
401 r_4 vts=(fgraw_)?((r_4)(*(paq.Data1()+j))):((r_4)(*(paq.Data1S()+j)));
402 ph1->Add((r_8)vts);
403 moysig[0] += (double)vts;
404 sigsig[0] += ((double)vts)*((double)vts);
405 nbsig[0]++;
406 }
407 for(sa_size_t j=0; j<vx.Size(); j++) {
408 r_4 vts=(fgraw_)?((r_4)(*(paq.Data2()+j))):((r_4)(*(paq.Data2S()+j)));
409 ph2->Add((r_8)vts);
410 moysig[1] += (double)vts;
411 sigsig[1] += ((double)vts)*((double)vts);
412 nbsig[1]++;
413 }
414 }
415 if (fgraw_) {
416 for(sa_size_t j=0; j<vx.Size(); j++)
417 vx(j) = (r_4)(*(paq.Data1()+j))-127.5;
418 // fftwf_complex* coeff1 = (fftwf_complex*)(procbuff+i*procpaqsz);
419 fftwf_execute(plan1);
420 // Traitement voie 2
421 for(sa_size_t j=0; j<vx.Size(); j++)
422 vx(j) = (r_4)(*(paq.Data2()+j))-127.5;
423 fftwf_execute(plan2);
424 }
425 else {
426 for(sa_size_t j=1; j<cfour1.Size()-1; j++) {
427 cfour1(j) = complex<r_4>((r_4)paq.Data1C()[j].realB(), (r_4)paq.Data1C()[j].imagB());
428 cfour2(j) = complex<r_4>((r_4)paq.Data2C()[j].realB(), (r_4)paq.Data2C()[j].imagB());
429 }
430 cfour1(0) = complex<r_4>((r_4)paq.Data1C()[0].realB(), (r_4)0.);
431 cfour1(cfour1.Size()-1) = complex<r_4>((r_4)paq.Data1C()[0].imagB(), (r_4)0.);
432 cfour2(0) = complex<r_4>((r_4)paq.Data2C()[0].realB(), (r_4)0.);
433 cfour2(cfour2.Size()-1) = complex<r_4>((r_4)paq.Data2C()[0].imagB(), (r_4)0.);
434 }
435 for(sa_size_t j=0; j<spectreV1.Size(); j++)
436 spectreV1(j) += Zmod2(cfour1(j));
437 memcpy(procbuff+i*procpaqsz, cfour1.Data(), sizeof(complex<r_4>)*cfour1.Size());
438 if (fgtimfreq) { // Remplissage tableau temps-frequence
439 for(sa_size_t c=1; c<timfreqV1.NCols(); c++) {
440 for(sa_size_t j=c*nfsmap_; j<(c+1)*nfsmap_; j++)
441 timfreqV1(nzm, c) += Zmod2(cfour1(j));
442 }
443 }
444 for(sa_size_t j=0; j<spectreV2.Size(); j++)
445 spectreV2(j) += Zmod2(cfour2(j)); // Zmod2(zp2[j]);
446 memcpy(procbuff+i*procpaqsz+procpaqsz/2, cfour2.Data(), sizeof(complex<r_4>)*cfour2.Size());
447 if (fgtimfreq) { // Remplissage tableau temps-frequence
448 for(sa_size_t c=1; c<timfreqV2.NCols(); c++) {
449 for(sa_size_t j=c*nfsmap_; j<(c+1)*nfsmap_; j++)
450 timfreqV2(nzm,c) += Zmod2(cfour2(j));
451 }
452 }
453
454// Calcul correlation (visibilite V1 * V2)
455 for(sa_size_t j=0; j<visiV12.Size(); j++)
456 visiV12(j)+=cfour1(j)*conj(cfour2(j));
457// for(sa_size_t j=0; j<visiV12.Size(); j++) visiV12(j)+=zp1[j]*zp2[j];
458 if (nzm==0) {
459 spectreV1.Info()["StartFC"] = curfc;
460 spectreV2.Info()["StartFC"] = curfc;
461 visiV12.Info()["StartFC"] = curfc;
462 spectreV1.Info()["StartTT"] = curtt;
463 spectreV2.Info()["StartTT"] = curtt;
464 visiV12.Info()["StartTT"] = curtt;
465 }
466 nzm++;
467/*----DELETE
468 if (nmnt==0) { xnt[0]=paq.FrameCounter(); xnt[1]=paq.TimeTag(); }
469 for(sa_size_t j=2700; j<2800; j++) {
470 ms1 += Zmod2(cfour1(j)); ms2 += Zmod2(cfour2(j));
471 complex<r_4> zvis = cfour1(j)*conj(cfour2(j));
472 ms12 += Zmod2(zvis); ms12re += zvis.real(); ms12im += zvis.imag();
473 ms12phi+= atan2(zvis.imag(),zvis.real());
474 }
475 nmnt++;
476----*/
477 totnbytesproc += paq.DataSize();
478 totnbytesout += (2*sizeof(complex<r_4>)*cfour1.Size());
479
480 } // Fin de boucle sur les paquets d'une zone
481
482/*---- DELETE
483 if (nmnt>0) {
484 double fnorm = (double)nmnt*(2800-2700);
485 xnt[2] = ms1 /= fnorm;
486 xnt[3] = ms2 /= fnorm;
487 xnt[4] = ms12 /= fnorm;
488 xnt[5] = ms12re /= fnorm;
489 xnt[6] = ms12im /= fnorm;
490 xnt[7] = ms12phi /= fnorm;
491 nt.Fill(xnt);
492 }
493----*/
494 if ((nzm >= nmean_) || ((kmz==(nmax_-1))&&(nzm>1))) {
495 spectreV1 /= (r_4)(nzm);
496 spectreV2 /= (r_4)(nzm);
497
498 // pour le calcul des moyennes et sigmas de ces spectres
499 moyspecV1 += spectreV1;
500 moyspecV2 += spectreV2;
501 sigspecV1 += (spectreV1 && spectreV1);
502 sigspecV2 += (spectreV2 && spectreV2);
503 nmoyspec++;
504
505 visiV12 /= complex<r_4>((r_4)nzm, 0.);
506
507 spectreV1.Info()["NPaqMoy"] = nzm;
508 spectreV2.Info()["NPaqMoy"] = nzm;
509 visiV12.Info()["NPaqMoy"] = nzm;
510 spectreV1.Info()["EndFC"] = curfc;
511 spectreV2.Info()["EndFC"] = curfc;
512 visiV12.Info()["EndFC"] = curfc;
513 spectreV1.Info()["EndTT"] = curtt;
514 spectreV2.Info()["EndTT"] = curtt;
515 visiV12.Info()["EndTT"] = curtt;
516 {
517 sprintf(fname,"%s_%d.ppf",path_.c_str(),(int)ifile);
518 POutPersist po(fname);
519 string tag1="specV1";
520 string tag2="specV2";
521 string tag12="visiV12";
522 string tagh1="tshV1";
523 string tagh2="tshV2";
524 string tagtf1="timfreqV1";
525 string tagtf2="timfreqV2";
526 if (card_==2) {
527 tag1 = "specV3";
528 tag2 = "specV4";
529 tagh1 = "tshV1";
530 tagh2 = "tshV2";
531 tag12="visiV34";
532 tagtf1="timfreqV3";
533 tagtf2="timfreqV4";
534 }
535 po << PPFNameTag(tag1) << spectreV1;
536 po << PPFNameTag(tag2) << spectreV2;
537 po << PPFNameTag(tag12) << visiV12;
538 if (fghist_) {
539 po << PPFNameTag(tagh1) << (*ph1);
540 po << PPFNameTag(tagh2) << (*ph2);
541
542 double sspvmax[3] = {0.,0.,0.};
543 int_4 sspvmaxidx[3] = {-1,-1,-1};
544 for(int jji=1;jji<visiV12.Size()-1;jji++) {
545 r_4 zmv2 = Zmod2(visiV12(jji));
546 if (zmv2>sspvmax[2]) { sspvmax[2]=zmv2; sspvmaxidx[2]=jji; }
547 }
548 TVector<r_4>& sspv = spectreV1;
549 for(int ic=0; ic<2; ic++) {
550 if (ic==1) sspv = spectreV2;
551 for(int jji=1;jji<sspv.Size()-1;jji++)
552 if (sspv(jji)>sspvmax[ic]) { sspvmax[ic]=sspv(jji); sspvmaxidx[ic]=jji; }
553 if (nbsig[ic] < 1) { moysig[ic]=sigsig[ic]=-1.; }
554 else {
555 moysig[ic] /= (double)nbsig[ic];
556 sigsig[ic] /= (double)nbsig[ic];
557 sigsig[ic] -= (moysig[ic]*moysig[ic]);
558 sigsig[ic] = sqrt(sigsig[ic]);
559 cout << "===Voie " << ic << " Moy=" << moysig[ic] << " Sig=" << sigsig[ic]
560 << " MaxSpec Amp= " << sqrt(sspvmax[ic])/double(pq.DataSize()/2/2)
561 << " Pos=" << sspvmaxidx[ic] << " (NPts=" << nbsig[ic] << ")" << endl;
562 }
563 }
564 cout << "=== Voie1x2 MaxSpec Amp= " << sqrt(sqrt(sspvmax[2])/double(pq.DataSize()/2/2))
565 << " Pos=" << sspvmaxidx[2] << endl;
566 } // fin if (fghist_)
567
568 if (fgtimfreq) {
569 timfreqV1 /= (r_4)nzm;
570 timfreqV2 /= (r_4)nzm;
571 po << PPFNameTag(tagtf1) << timfreqV1;
572 po << PPFNameTag(tagtf2) << timfreqV2;
573 }
574 }
575 spectreV1 = (r_4)(0.);
576 spectreV2 = (r_4)(0.);
577 visiV12 = complex<r_4>(0., 0.);
578 if (fghist_) {
579 ph1->Zero();
580 ph2->Zero();
581 moysig[0]=moysig[1]=0.;
582 sigsig[0]=sigsig[1]=0.;
583 nbsig[0]=nbsig[1]=0;
584 }
585 if (fgtimfreq) {
586 timfreqV1 = (r_4)(0.);
587 timfreqV2 = (r_4)(0.);
588 }
589 nzm = 0; ifile++;
590// ts.SetNow();
591// filog << ts << " : proc file " << fname << endl;
592 cout << " BRProcA2C::run() created file " << fname << card2name_(card_) << endl;
593 }
594
595 memgr.FreeMemZone(mid, MemZS_ProcA);
596 } // Fin de boucle sur les zones a traiter
597 cout << " ------------ BRProcA2C::run() END " << card2name_(card_)
598 << " ------------ " << endl;
599/*---- DELETE
600 {
601 nt.Info()["FirstTT"]=firsttt;
602 cout << nt;
603 sprintf(fname,"%s_nt.ppf",path_.c_str());
604 POutPersist po(fname);
605 po << PPFNameTag("ntv12") << nt;
606 cout << " BRProcA2C::run() created NTuple file " << fname << card2name_(card_) << endl;
607 }
608---- */
609 if (nmoyspec>0) { // Calcul des moyennes et sigmas des spectres
610 r_4 fnms = nmoyspec;
611 moyspecV1 /= fnms;
612 moyspecV2 /= fnms;
613 sigspecV1 /= fnms;
614 sigspecV2 /= fnms;
615 sigspecV1 -= (moyspecV1 && moyspecV1);
616 sigspecV2 -= (moyspecV2 && moyspecV2);
617 sigspecV1 = Sqrt(sigspecV1);
618 sigspecV2 = Sqrt(sigspecV2);
619 TVector<r_4> rsbV1, rsbV2; // Rapport signal/bruit
620 moyspecV1.DivElt(sigspecV1, rsbV1, false, true);
621 moyspecV2.DivElt(sigspecV2, rsbV2, false, true);
622 sprintf(fname,"%s_ms.ppf",path_.c_str());
623 POutPersist po(fname);
624 po << PPFNameTag("moyspecV1") << moyspecV1;
625 po << PPFNameTag("moyspecV2") << moyspecV2;
626 po << PPFNameTag("sigspecV1") << sigspecV1;
627 po << PPFNameTag("sigspecV2") << sigspecV2;
628 po << PPFNameTag("rsbV1") << rsbV1;
629 po << PPFNameTag("rsbV2") << rsbV2;
630 cout << " BRProcA2C::run() created moysigspec file " << fname << card2name_(card_) << endl;
631 }
632
633 if (fghist_) {
634 delete ph1;
635 delete ph2;
636 }
637 ts.SetNow();
638 tm.SplitQ();
639 cout << " TotalProc= " << totnbytesproc/(1024*1024) << " MBytes, rate= "
640 << (double)(totnbytesproc)/1024./tm.PartialElapsedTimems() << " MB/s"
641 << " ProcDataOut=" << totnbytesout/(1024*1024) << " MB" << endl;
642 cout << pcheck;
643 cout << " BRProcA2C::run()/Timing: " << card2name_(card_) << endl;
644 tm.Print();
645 cout << " ---------------------------------------------------------- " << endl;
646
647 }
648 catch (PException& exc) {
649 cout << " BRProcA2C::run()/catched PException " << exc.Msg() << endl;
650 setRC(3);
651 return;
652 }
653 catch(...) {
654 cout << " BRProcA2C::run()/catched unknown ... exception " << endl;
655 setRC(4);
656 return;
657 }
658 setRC(0);
659 return;
660}
661
662//---------------------------------------------------------------------
663// Classe thread de traitement 2 x 2 voies/frames (Apres BRProcA2C)
664//---------------------------------------------------------------------
665
666/* --Methode-- */
667BRProcB4C::BRProcB4C(RAcqMemZoneMgr& mem1, RAcqMemZoneMgr& mem2, string& path,
668 bool fgraw, uint_4 nmean, uint_4 nmax, bool fgnotrl)
669 : memgr1(mem1), memgr2(mem2)
670{
671 fgraw_ = fgraw;
672 nmax_ = nmax;
673 nmean_ = nmean;
674 if (fgraw_) cout << " BRProcB4C::BRProcB4C() - constructeur RAW data - NMean= " << nmean_ << endl;
675 else cout << " BRProcB4C::BRProcB4C() - constructeur FFT data - NMean= " << nmean_ << endl;
676 stop_ = false;
677 path_ = path;
678 fgnotrl_ = fgnotrl;
679}
680
681/* --Methode-- */
682void BRProcB4C::Stop()
683{
684 stop_=true;
685 // cout <<" BRProcB4C::Stop ... > STOP " << endl;
686}
687
688
689/* --Methode-- */
690void BRProcB4C::run()
691{
692 setRC(1);
693 try {
694 Timer tm("BRProcB4C", false);
695 TimeStamp ts;
696 BRPaqChecker pcheck1(!fgnotrl_); // Verification/comptage des paquets
697 BRPaqChecker pcheck2(!fgnotrl_); // Verification/comptage des paquets
698
699 size_t totnbytesout = 0;
700 size_t totnbytesproc = 0;
701
702 cout << " BRProcB4C::run() - Starting " << ts << " NMaxMemZones=" << nmax_
703 << " NMean=" << nmean_ << endl;
704 cout << " BRProcB4C::run()... - Output Data Path: " << path_ << endl;
705
706 uint_4 paqsz = memgr1.PaqSize();
707 uint_4 procpaqsz = memgr1.ProcPaqSize();
708 if ((paqsz != memgr2.PaqSize())||(procpaqsz!= memgr2.ProcPaqSize())) {
709 cout << "BRProcB4C::run()/ERROR : different paquet size -> stop \n ...(PaqSz1="
710 << paqsz << " Sz2=" << memgr2.PaqSize() << " ProcPaqSz1="
711 << procpaqsz << " Sz2=" << memgr2.ProcPaqSize() << " )" << endl;
712 setRC(9);
713 return;
714 }
715
716 TVector< complex<r_4> > cfour; // composant TF
717 BRPaquet pq(NULL, NULL, paqsz);
718/*
719 TVector<r_4> vx(pq.DataSize()/2);
720 vx = (r_4)(0.);
721 FFTPackServer ffts;
722 ffts.FFTForward(vx, cfour);
723
724 TVector< complex<r_4> > visiV13( cfour.Size() );
725 TVector< complex<r_4> > visiV14( cfour.Size() );
726 TVector< complex<r_4> > visiV23( cfour.Size() );
727 TVector< complex<r_4> > visiV24( cfour.Size() );
728*/
729 int szfour = pq.DataSize()/2/2+1;
730// int szfour = (paqsz-40)/2+1;
731 TVector< complex<r_4> > visiV13( szfour );
732 TVector< complex<r_4> > visiV14( szfour );
733 TVector< complex<r_4> > visiV23( szfour );
734 TVector< complex<r_4> > visiV24( szfour );
735 // cout << " *DBG*AAAAA ---- Vectors OK" << endl;
736 cout << " *DBG*BRProcB4C PaqSz=" << paqsz << " ProcPaqSize=" << procpaqsz
737 << " procpaqsz/2=" << procpaqsz/2 << " cfour.Size()=" << szfour
738 << " *8=" << szfour*8 << endl;
739
740 DataTable dt;
741 dt.AddLongColumn("fc1");
742 dt.AddLongColumn("tt1");
743 dt.AddLongColumn("fc2");
744 dt.AddLongColumn("tt2");
745 DataTableRow dtr = dt.EmptyRow();
746
747 uint_4 nzm = 0;
748 uint_4 totnoksfc = 0;
749 uint_4 totnokpaq = 0;
750 uint_4 totnpaq = 0;
751 uint_4 ifile = 0;
752
753 uint_4 curfc=0;
754 uint_8 curtt=0;
755 uint_4 curfc2=0;
756 uint_8 curtt2=0;
757 uint_8 firsttt=0;
758 uint_8 firsttt2=0;
759 bool fgfirst=true;
760 for (uint_4 kmz=0; kmz<nmax_; kmz++) {
761 uint_4 noksfc = 0;
762 uint_4 nokpaq = 0;
763 if (stop_) break;
764 // cout << " *DBG*BBBBB" << kmz << endl;
765
766 int mid1 = memgr1.FindMemZoneId(MemZA_ProcB);
767 Byte* buff1 = memgr1.GetMemZone(mid1);
768 if (buff1 == NULL) {
769 cout << " BRProcB4C::run()/ERROR memgr.GetMemZone(" << mid1 << ") -> NULL" << endl;
770 break;
771 }
772 Byte* procbuff1 = memgr1.GetProcMemZone(mid1);
773 if (procbuff1 == NULL) {
774 cout << " BRProcB4C::run()/ERROR memgr.GetProcMemZone(" << mid1 << ") -> NULL" << endl;
775 break;
776 }
777 int mid2 = memgr2.FindMemZoneId(MemZA_ProcB);
778 Byte* buff2 = memgr2.GetMemZone(mid2);
779 if (buff1 == NULL) {
780 cout << " BRProcB4C::run()/ERROR memgr.GetMemZone(" << mid2 << ") -> NULL" << endl;
781 break;
782 }
783 Byte* procbuff2 = memgr2.GetProcMemZone(mid2);
784 if (procbuff2 == NULL) {
785 cout << " BRProcB4C::run()/ERROR memgr.GetProcMemZone(" << mid2 << ") -> NULL" << endl;
786 break;
787 }
788 uint_4 i1,i2;
789 i1=i2=0;
790// cout << " *DBG*CCCCCC " << kmz << " memgr1.NbPaquets() =" << memgr1.NbPaquets() << endl;
791 while((i1<memgr1.NbPaquets())&&(i2<memgr2.NbPaquets())) {
792 BRPaquet paq1(NULL, buff1+i1*paqsz, paqsz);
793 BRPaquet paq2(NULL, buff2+i2*paqsz, paqsz);
794 totnpaq++;
795// cout << " DBG["<<kmz<<"] i1,i2=" << i1 <<","<<i2<<" FC1,FC2=" <<paq1.FrameCounter()
796//<<","<<paq2.FrameCounter()<<endl;
797 // on ne traite que les paquets OK
798 if (!pcheck1.Check(paq1)) { i1++; continue; }
799 if (!pcheck2.Check(paq2)) { i2++; continue; }
800 nokpaq++;
801 if (paq1.FrameCounter()<paq2.FrameCounter()) { i1++; continue; }
802 if (paq2.FrameCounter()<paq1.FrameCounter()) { i2++; continue; }
803// cout << " DBG["<<kmz<<"]OKOK i1,i2=" << i1 <<","<<i2<<" FC1,FC2=" <<paq1.FrameCounter()
804// <<","<<paq2.FrameCounter()<<endl;
805
806 if ((i1>=memgr1.NbPaquets())||(i2>=memgr1.NbPaquets())) {
807 cout << " *BUG*BUG i1=" << i1 << " i2=" << i2 << endl;
808 break;
809 }
810 // Les deux framecounters sont identiques ...
811 noksfc++;
812 curfc=paq1.FrameCounter();
813 curfc2=paq2.FrameCounter();
814 if (fgfirst) {
815 firsttt=paq1.TimeTag(); firsttt2=paq2.TimeTag();
816 cout << " BRProcB4C()/Info First FC="<<curfc<<" , "<<curfc2<<" -> TT="
817 << firsttt<<" , "<<firsttt2 <<endl;
818 fgfirst=false;
819 }
820 curtt=paq1.TimeTag()-firsttt;
821 curtt2=paq2.TimeTag()-firsttt2;
822 dtr[0]=curfc; dtr[1]=curtt;
823 dtr[2]=curfc2; dtr[3]=curtt2;
824 dt.AddRow(dtr);
825
826 complex<r_4>* zp1 = (complex<r_4>*)(procbuff1+i1*procpaqsz);
827 complex<r_4>* zp2 = (complex<r_4>*)(procbuff1+i1*procpaqsz+procpaqsz/2);
828 complex<r_4>* zp3 = (complex<r_4>*)(procbuff2+i2*procpaqsz);
829 complex<r_4>* zp4 = (complex<r_4>*)(procbuff2+i2*procpaqsz+procpaqsz/2);
830 for(sa_size_t j=0; j<visiV13.Size(); j++) {
831 visiV13(j)+=zp1[j]*conj(zp3[j]);
832 visiV14(j)+=zp1[j]*conj(zp4[j]);
833 visiV23(j)+=zp2[j]*conj(zp3[j]);
834 visiV24(j)+=zp2[j]*conj(zp4[j]);
835 }
836 if (nzm==0) {
837 visiV13.Info()["StartFC"] = curfc;
838 visiV14.Info()["StartFC"] = curfc;
839 visiV23.Info()["StartFC"] = curfc;
840 visiV24.Info()["StartFC"] = curfc;
841 visiV13.Info()["StartTT"] = curtt;
842 visiV14.Info()["StartTT"] = curtt;
843 visiV23.Info()["StartTT"] = curtt;
844 visiV24.Info()["StartTT"] = curtt;
845 }
846 nzm++; i1++; i2++;
847 totnbytesproc += 2*paq1.DataSize();
848 } // Fin de boucle sur les paquets d'une zone
849 memgr1.FreeMemZone(mid1, MemZS_ProcB);
850 memgr2.FreeMemZone(mid2, MemZS_ProcB);
851
852 if ((nzm >= nmean_) || ((kmz==(nmax_-1))&&(nzm>1))) {
853 visiV13 /= complex<r_4>((r_4)nzm, 0.);
854 visiV14 /= complex<r_4>((r_4)nzm, 0.);
855 visiV23 /= complex<r_4>((r_4)nzm, 0.);
856 visiV24 /= complex<r_4>((r_4)nzm, 0.);
857 visiV13.Info()["NPaqMoy"] = nzm;
858 visiV14.Info()["NPaqMoy"] = nzm;
859 visiV23.Info()["NPaqMoy"] = nzm;
860 visiV24.Info()["NPaqMoy"] = nzm;
861 visiV13.Info()["EndFC"] = curfc;
862 visiV14.Info()["EndFC"] = curfc;
863 visiV23.Info()["EndFC"] = curfc;
864 visiV24.Info()["EndFC"] = curfc;
865 visiV13.Info()["EndTT"] = curtt;
866 visiV14.Info()["EndTT"] = curtt;
867 visiV23.Info()["EndTT"] = curtt;
868 visiV24.Info()["EndTT"] = curtt;
869 char fname[512];
870 {
871 sprintf(fname,"%s_%d.ppf",path_.c_str(),(int)ifile);
872 POutPersist po(fname);
873 po << PPFNameTag("visiV13") << visiV13;
874 po << PPFNameTag("visiV14") << visiV14;
875 po << PPFNameTag("visiV23") << visiV23;
876 po << PPFNameTag("visiV24") << visiV24;
877 }
878 visiV13 = complex<r_4>(0., 0.);
879 visiV14 = complex<r_4>(0., 0.);
880 visiV23 = complex<r_4>(0., 0.);
881 visiV24 = complex<r_4>(0., 0.);
882 nzm = 0; ifile++;
883// ts.SetNow();
884// filog << ts << " : proc file " << fname << endl;
885 cout << " BRProcB4C::run() created file " << fname << endl;
886 }
887 double okfrac = (nokpaq>1)?((double)noksfc/(double)nokpaq*100.):0.;
888 cout << "BRProcB4C ["<<kmz<<"] NOKPaq=" << nokpaq << " NSameFC=" << noksfc
889 << " (" << okfrac << " %)" << endl;
890 totnokpaq += nokpaq;
891 totnoksfc += noksfc;
892 } // Fin de boucle sur les zones a traiter
893 cout << " ------------------ BRProcB4C::run() END ----------------- " << endl;
894 {
895 dt.Info()["FirstTT1"]=firsttt;
896 dt.Info()["FirstTT2"]=firsttt2;
897 cout << dt;
898 char fname[512];
899 sprintf(fname,"%s_fctt.ppf",path_.c_str());
900 POutPersist po(fname);
901 po << PPFNameTag("ttfc") << dt;
902 cout << " BRProcB4C::run() created TimeTag/FrameCounter file " << fname << endl;
903 }
904 ts.SetNow();
905 tm.SplitQ();
906 cout << " TotalProc= " << totnbytesproc/(1024*1024) << " MBytes, rate= "
907 << (double)(totnbytesproc)/1024./tm.PartialElapsedTimems() << " MB/s" << endl;
908 double totokfrac = (totnokpaq>1)?((double)totnoksfc/(double)totnokpaq*100.):0.;
909 cout << " NOkPaq1,2=" << totnokpaq << " /TotNPaq=" << totnpaq << " TotNSameFC="
910 << totnoksfc << " (" << totokfrac << " %)" << endl;
911// cout << pcheck1;
912// cout << pcheck2;
913 cout << " BRProcB4C::run()/Timing: \n";
914 tm.Print();
915 cout << " ---------------------------------------------------------- " << endl;
916}
917 catch (PException& exc) {
918 cout << " BRProcB4C::run()/catched PException " << exc.Msg() << endl;
919 setRC(3);
920 return;
921 }
922 catch(...) {
923 cout << " BRProcB4C::run()/catched unknown ... exception " << endl;
924 setRC(4);
925 return;
926 }
927 setRC(0);
928 return;
929}
930
931
Note: See TracBrowser for help on using the repository browser.