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

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

Introduction de la classe FitsCubeWriter - Reza 28/11/2009

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