/[PAMELA software]/DarthVader/TrackerLevel2/src/TrkLevel2.cpp
ViewVC logotype

Diff of /DarthVader/TrackerLevel2/src/TrkLevel2.cpp

Parent Directory Parent Directory | Revision Log Revision Log | View Patch Patch

revision 1.33 by pam-fi, Mon May 14 11:03:05 2007 UTC revision 1.39 by pam-fi, Wed Aug 22 07:03:45 2007 UTC
# Line 12  using namespace std; Line 12  using namespace std;
12  extern "C" {      extern "C" {    
13      void dotrack_(int*, double*, double*, double*, double*, int*);      void dotrack_(int*, double*, double*, double*, double*, int*);
14      void dotrack2_(int*, double*, double*, double*, double*,double*, double*, double*,int*);      void dotrack2_(int*, double*, double*, double*, double*,double*, double*, double*,int*);
15       void mini2_(int*,int*,int*);      void mini2_(int*,int*,int*);
16       void guess_();      void guess_();
17        void gufld_(float*, float*);
18        float risxeta2_(float *);
19        float risxeta3_(float *);
20        float risxeta4_(float *);
21        float risyeta2_(float *);
22  }  }
23    
24  //--------------------------------------  //--------------------------------------
# Line 360  Int_t TrkTrack::GetLeverArmY(){ Line 365  Int_t TrkTrack::GetLeverArmY(){
365      }      }
366      return (last_plane-first_plane+1);      return (last_plane-first_plane+1);
367  }  }
368    /**
369     * Returns the reduced chi-square of track x-projection
370     */
371    Float_t  TrkTrack::GetChi2X(){
372        float chiq=0;
373        for(int ip=0; ip<6; ip++)if(XGood(ip))chiq+= pow((xv[ip]-xm[ip])/resx[ip],2.);
374        if(GetNX()>3)chiq=chiq/(GetNX()-3);
375        else chiq=0;
376        if(chiq==0)cout << " Float_t  TrkTrack::GetChi2X() -- WARNING -- value not defined "<<chiq<<endl;
377        return chiq;
378    }
379    /**
380     * Returns the reduced chi-square of track y-projection
381     */
382    Float_t  TrkTrack::GetChi2Y(){
383        float chiq=0;
384        for(int ip=0; ip<6; ip++)if(YGood(ip))chiq+= pow((yv[ip]-ym[ip])/resy[ip],2.);
385        if(GetNY()>2)chiq=chiq/(GetNY()-2);
386        else chiq=0;
387        if(chiq==0)cout << " Float_t  TrkTrack::GetChi2Y() -- WARNING -- value not defined "<<chiq<<endl;
388        return chiq;
389    }
390    /**
391     * Returns the logarythm of the likeliwood-function of  track x-projection
392     */
393    Float_t TrkTrack::GetLnLX(){
394        float lnl=0;
395        for(int ip=0; ip<6; ip++)
396            if( XGood(ip) && tailx[ip]!=0 )
397                lnl += (tailx[ip]+1.) * log( (tailx[ip]*pow(resx[ip],2.) + pow(xv[ip]-xm[ip],2.)) / (tailx[ip]*pow(resx[ip],2)) );
398        if(GetNX()>3)lnl=lnl/(GetNX()-3);
399        else lnl=0;
400        if(lnl==0){
401            cout << " Float_t  TrkTrack::GetLnLX() -- WARNING -- value not defined "<<lnl<<endl;
402            Dump();
403        }
404        return lnl;
405        
406    }
407    /**
408     * Returns the logarythm of the likeliwood-function of  track y-projection
409     */
410    Float_t TrkTrack::GetLnLY(){
411        float lnl=0;
412        for(int ip=0; ip<6; ip++)
413            if( YGood(ip) && taily[ip]!=0 )
414                lnl += (taily[ip]+1.) * log( (taily[ip]*pow(resy[ip],2.) + pow(yv[ip]-ym[ip],2.)) / (taily[ip]*pow(resy[ip],2)) );
415        if(GetNY()>2)lnl=lnl/(GetNY()-2);
416        else lnl=0;
417        if(lnl==0){
418            cout << " Float_t  TrkTrack::GetLnLY() -- WARNING -- value not defined "<<lnl<<endl;
419            Dump();
420        }
421        return lnl;
422        
423    }
424    /**
425     * Returns the effective angle, relative to the sensor, on each plane.
426     * @param ip plane (0-5)
427     * @param iv view (0=x 1=y)
428     */
429    Float_t TrkTrack::GetEffectiveAngle(int ip, int iv){
430    
431        if(ip<0 || ip>5){
432            cout << "Float_t TrkTrack::GetEffectiveAngle(int "<<ip<<", int "<<iv<<") ==> wrong input"<<endl;
433            return 0.;
434        }
435    
436        float v[3]={xv[ip],yv[ip],zv[ip]};
437        //-----------------------------------------
438        // effective angle (relative to the sensor)
439        //-----------------------------------------
440        float axv_geo  = axv[ip];
441        float muhall_h = 297.61; //cm**2/Vs
442        float BY = TrkParams::GetBY(v);
443        float axv_eff = 0;
444        if(ip==5) axv_geo = -1*axv_geo;
445        if(ip==5) BY      = -1*BY;
446        axv_eff = 180.*atan( tan(axv_geo*acos(-1.)/180.) + muhall_h * BY * 0.0001)/acos(-1.);
447        //-----------------------------------------
448        // effective angle (relative to the sensor)
449        //-----------------------------------------
450        float ayv_geo = ayv[ip];
451        float muhall_e = 1258.18; //cm**2/Vs
452        float BX = TrkParams::GetBX(v);
453        float ayv_eff = 0;
454        ayv_eff = 180.*atan( tan(ayv_geo*acos(-1.)/180.) + muhall_e * BX * 0.0001)/acos(-1.);
455      
456        if     (iv==0)return axv_eff;
457        else if(iv==1)return ayv_eff;
458        else{
459            cout << "Float_t TrkTrack::GetEffectiveAngle(int "<<ip<<", int "<<iv<<") ==> wrong input"<<endl;
460            return 0.;
461        }
462      
463    };
464    
465  //--------------------------------------  //--------------------------------------
466  //  //
467  //  //
# Line 381  void TrkTrack::Dump(){ Line 483  void TrkTrack::Dump(){
483      cout << endl << "zv       : "; for(int i=0; i<6; i++)cout << zv[i] << " ";      cout << endl << "zv       : "; for(int i=0; i<6; i++)cout << zv[i] << " ";
484      cout << endl << "resx     : "; for(int i=0; i<6; i++)cout << resx[i] << " ";      cout << endl << "resx     : "; for(int i=0; i<6; i++)cout << resx[i] << " ";
485      cout << endl << "resy     : "; for(int i=0; i<6; i++)cout << resy[i] << " ";      cout << endl << "resy     : "; for(int i=0; i<6; i++)cout << resy[i] << " ";
486        cout << endl << "tailx    : "; for(int i=0; i<6; i++)cout << tailx[i] << " ";
487        cout << endl << "taily    : "; for(int i=0; i<6; i++)cout << taily[i] << " ";
488      cout << endl << "coval    : "; for(int i=0; i<5; i++)cout << coval[0][i]<<" ";      cout << endl << "coval    : "; for(int i=0; i<5; i++)cout << coval[0][i]<<" ";
489      cout << endl << "           "; for(int i=0; i<5; i++)cout << coval[1][i]<<" ";      cout << endl << "           "; for(int i=0; i<5; i++)cout << coval[1][i]<<" ";
490      cout << endl << "           "; for(int i=0; i<5; i++)cout << coval[2][i]<<" ";      cout << endl << "           "; for(int i=0; i<5; i++)cout << coval[2][i]<<" ";
# Line 406  void TrkTrack::SetResolution(double *rx, Line 510  void TrkTrack::SetResolution(double *rx,
510      for(int i=0; i<6; i++) resy[i]=*ry++;      for(int i=0; i<6; i++) resy[i]=*ry++;
511  }  }
512  /**  /**
513   * Set the TrkTrack good measurement.   * Set the TrkTrack tails position resolution
514     */
515    void TrkTrack::SetTail(double *tx, double *ty, double factor){
516        for(int i=0; i<6; i++) tailx[i]=factor*(*tx++);
517        for(int i=0; i<6; i++) taily[i]=factor*(*ty++);
518    }
519    /**
520     * Set the TrkTrack Student parameter (resx,resy,tailx,taily)
521     * from previous gausian fit
522     *@param flag =0 standard, =1 with noise correction
523     */
524    void TrkTrack::SetStudentParam(int flag){
525        float sx[11]={0.000128242,
526                       0.000136942,
527                       0.000162718,
528                       0.000202644,
529                       0.00025597,
530                       0.000317456,
531                       0.000349048,
532                       0.000384638,
533                       0.000457295,
534                       0.000512319,
535                       0.000538573};
536        float tx[11]={1.79402,
537                       2.04876,
538                       2.88376,
539                       3.3,
540                       3.14084,
541                       4.07686,
542                       4.44736,
543                       3.5179,
544                       3.38697,
545                       3.45739,
546                       3.18627};
547        float sy[11]={0.000483075,
548                       0.000466925,
549                       0.000431658,
550                       0.000428317,
551                       0.000433854,
552                       0.000444044,
553                       0.000482098,
554                       0.000537579,
555                       0.000636279,
556                       0.000741998,
557                       0.000864261};
558        float ty[11]={0.997032,
559                       1.11147,
560                       1.18526,
561                       1.61404,
562                       2.21908,
563                       3.08959,
564                       4.48833,
565                       4.42687,
566                       4.65253,
567                       4.52043,
568                       4.29926};
569        int index;
570        float fact;
571        for(int i=0; i<6; i++) {
572            index = int((fabs(axv[i])+1.)/2.);
573            if(index>10) index=10;
574            tailx[i]=tx[index];
575            if(flag==1) {
576                if(fabs(axv[i])<=10.) fact = resx[i]/risxeta2_(&(axv[i]));
577                if(fabs(axv[i])>10.&&fabs(axv[i])<=15.) fact = resx[i]/risxeta3_(&(axv[i]));
578                if(fabs(axv[i])>15.) fact = resx[i]/risxeta4_(&(axv[i]));
579            } else fact = 1.;
580            resx[i] = sx[index]*fact;
581        }
582        for(int i=0; i<6; i++) {
583            index = int((fabs(ayv[i])+1.)/2.);
584            if(index>10) index=10;
585            taily[i]=ty[index];
586            if(flag==1) fact = resy[i]/risyeta2_(&(ayv[i]));
587            else fact = 1.;
588            resy[i] = sy[index]*fact;
589        }
590    }
591    /**
592     * Set the TrkTrack good measurement
593   */   */
594  void TrkTrack::SetGood(int *xg, int *yg){  void TrkTrack::SetGood(int *xg, int *yg){
595    
# Line 468  void TrkTrack::FillMiniStruct(cMini2trac Line 651  void TrkTrack::FillMiniStruct(cMini2trac
651                    
652          track.resx[i]=resx[i];          track.resx[i]=resx[i];
653          track.resy[i]=resy[i];          track.resy[i]=resy[i];
654            track.tailx[i]=tailx[i];
655            track.taily[i]=taily[i];
656      }      }
657    
658      for(int i=0; i<5; i++) track.al[i]=al[i];      for(int i=0; i<5; i++) track.al[i]=al[i];
# Line 523  void TrkTrack::SetFromMiniStruct(cMini2t Line 708  void TrkTrack::SetFromMiniStruct(cMini2t
708   *   *
709   * @see TrkParams::SetPFA(int)   * @see TrkParams::SetPFA(int)
710   */   */
711  void TrkTrack::EvaluateClusterPositions(){  Bool_t TrkTrack::EvaluateClusterPositions(){
712            
713  //     cout << "void TrkTrack::GetClusterPositions() "<<endl;  //     cout << "void TrkTrack::GetClusterPositions() "<<endl;
714    
715      TrkParams::Load( );      TrkParams::Load( );
716      if( !TrkParams::IsLoaded() )return;      if( !TrkParams::IsLoaded() )return false;
717            
718      for(int ip=0; ip<6; ip++){      for(int ip=0; ip<6; ip++){
719  //      cout << ip<<" ** "<<xm[ip]<<" / "<<ym[ip]<<endl;;  //      cout << ip<<" ** "<<xm[ip]<<" / "<<ym[ip]<<endl;;
# Line 547  void TrkTrack::EvaluateClusterPositions( Line 732  void TrkTrack::EvaluateClusterPositions(
732          float bfy = 10*TrkParams::GetBY(v);//Tesla          float bfy = 10*TrkParams::GetBY(v);//Tesla
733          int ipp=ip+1;          int ipp=ip+1;
734          xyzpam_(&ipp,&icx,&icy,&ladder,&sensor,&ax,&ay,&bfx,&bfy);          xyzpam_(&ipp,&icx,&icy,&ladder,&sensor,&ax,&ay,&bfx,&bfy);
735            if(icx<0 || icy<0)return false;
736      }      }
737        return true;
738  }  }
739  /**  /**
740   * \brief Tracking method. It calls F77 mini routine.   * \brief Tracking method. It calls F77 mini routine.
# Line 585  void TrkTrack::Fit(double pfixed, int& f Line 772  void TrkTrack::Fit(double pfixed, int& f
772    
773      extern cMini2track track_;      extern cMini2track track_;
774      fail = 0;      fail = 0;
775    
776      FillMiniStruct(track_);      FillMiniStruct(track_);
777                
778      if(froml1!=0)EvaluateClusterPositions();      if(froml1!=0){
779            if( !EvaluateClusterPositions() ){
780                cout << "void TrkTrack::Fit("<<pfixed<<","<<fail<<","<<iprint<<","<<froml1<<") --- ERROR evaluating cluster positions "<<endl;
781                FillMiniStruct(track_) ;
782                fail = 1;
783                return;
784            }
785        }else{
786            FillMiniStruct(track_);
787        }
788            
789      // if fit variables have been reset, evaluate the initial guess      // if fit variables have been reset, evaluate the initial guess
790      if(al[0]==-9999.&&al[1]==-9999.&&al[2]==-9999.&&al[3]==-9999.&&al[4]==-9999.)guess_();      if(al[0]==-9999.&&al[1]==-9999.&&al[2]==-9999.&&al[3]==-9999.&&al[4]==-9999.)guess_();
# Line 660  void TrkTrack::SetPrecisionFactor(double Line 857  void TrkTrack::SetPrecisionFactor(double
857      track_.fact = fact;      track_.fact = fact;
858  }  }
859  /**  /**
860   * Set the factor scale for tracking precision   * Set the minimum number of steps for tracking precision
861   */   */
862  void TrkTrack::SetStepMin(int istepmin){  void TrkTrack::SetStepMin(int istepmin){
863      extern cMini2track track_;      extern cMini2track track_;
864      track_.istepmin = istepmin;      track_.istepmin = istepmin;
865  }  }
866    /**
867     * Returns 1 if the track is inside the magnet cavity
868     * Set the minimum number of steps for tracking precision
869     */
870    Bool_t TrkTrack::IsInsideCavity(){
871        float xmagntop, ymagntop, xmagnbottom, ymagnbottom;
872        xmagntop = xv[0] + (ZMAGNHIGH-zv[0])*tan(cos(-1.0)*axv[0]/180.);
873        ymagntop = yv[0] + (ZMAGNHIGH-zv[0])*tan(cos(-1.0)*ayv[0]/180.);
874        xmagnbottom = xv[5] + (ZMAGNLOW-zv[5])*tan(cos(-1.0)*axv[5]/180.);
875        ymagnbottom = yv[5] + (ZMAGNLOW-zv[5])*tan(cos(-1.0)*ayv[5]/180.);
876        if( xmagntop>XMAGNLOW && xmagntop<XMAGNHIGH &&
877            ymagntop>YMAGNLOW && ymagntop<YMAGNHIGH &&
878            xmagnbottom>XMAGNLOW && xmagnbottom<XMAGNHIGH &&
879            ymagnbottom>YMAGNLOW && ymagnbottom<YMAGNHIGH ) return(true);
880        else return(false);
881    }
882  /**  /**
883   * Method to retrieve ID (0,1,...) of x-cluster (if any) associated to this track.   * Method to retrieve ID (0,1,...) of x-cluster (if any) associated to this track.
884   * If no cluster is associated, ID=-1.   * If no cluster is associated, ID=-1.
# Line 884  void TrkLevel2::Dump(){ Line 1095  void TrkLevel2::Dump(){
1095          for(int i=0; i<nclsy(); i++) ((TrkSinglet *)sy[i])->Dump();          for(int i=0; i<nclsy(); i++) ((TrkSinglet *)sy[i])->Dump();
1096      }      }
1097  }  }
1098    /**
1099     * \brief Dump processing status
1100     */
1101    void TrkLevel2::StatusDump(int view){
1102        cout << "DSP n. "<<view+1<<" status: "<<hex<<good[view]<<endl;    
1103    };
1104    /**
1105     * \brief Check event status
1106     *
1107     * Check the event status, according to a flag-mask given as input.
1108     * Return true if the view passes the check.
1109     *
1110     * @param view View number (0-11)
1111     * @param flagmask Mask of flags to check (eg. flagmask=0x111 no missing packet,
1112     *  no crc error, no software alarm)
1113     *
1114     * @see TrkLevel2 class definition to know how the status flag is defined
1115     *
1116     */
1117    Bool_t TrkLevel2::StatusCheck(int view, int flagmask){
1118    
1119        if( view<0 || view >= 12)return false;
1120        return !(good[view]&flagmask);
1121    
1122    };
1123    
1124    
1125  //--------------------------------------  //--------------------------------------
1126  //  //
1127  //  //
Legend:
Removed from v.1.33  
changed lines
  Added in v.1.39
  ViewVC Help
Powered by ViewVC 1.1.23