/[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.37 by pam-fi, Wed Jun 6 09:36:07 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)cout << " Float_t  TrkTrack::GetLnLX() -- WARNING -- value not defined "<<lnl<<endl;
401        return lnl;
402        
403    }
404    /**
405     * Returns the logarythm of the likeliwood-function of  track y-projection
406     */
407    Float_t TrkTrack::GetLnLY(){
408        float lnl=0;
409        for(int ip=0; ip<6; ip++)
410            if( YGood(ip) && taily[ip]!=0 )
411                lnl += (taily[ip]+1.) * log( (taily[ip]*pow(resy[ip],2.) + pow(yv[ip]-ym[ip],2.)) / (taily[ip]*pow(resy[ip],2)) );
412        if(GetNY()>2)lnl=lnl/(GetNY()-2);
413        else lnl=0;
414        if(lnl==0)cout << " Float_t  TrkTrack::GetLnLY() -- WARNING -- value not defined "<<lnl<<endl;
415        return lnl;
416        
417    }
418  //--------------------------------------  //--------------------------------------
419  //  //
420  //  //
# Line 381  void TrkTrack::Dump(){ Line 436  void TrkTrack::Dump(){
436      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] << " ";
437      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] << " ";
438      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] << " ";
439        cout << endl << "tailx    : "; for(int i=0; i<6; i++)cout << tailx[i] << " ";
440        cout << endl << "taily    : "; for(int i=0; i<6; i++)cout << taily[i] << " ";
441      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]<<" ";
442      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]<<" ";
443      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 463  void TrkTrack::SetResolution(double *rx,
463      for(int i=0; i<6; i++) resy[i]=*ry++;      for(int i=0; i<6; i++) resy[i]=*ry++;
464  }  }
465  /**  /**
466   * Set the TrkTrack good measurement.   * Set the TrkTrack tails position resolution
467     */
468    void TrkTrack::SetTail(double *tx, double *ty, double factor){
469        for(int i=0; i<6; i++) tailx[i]=factor*(*tx++);
470        for(int i=0; i<6; i++) taily[i]=factor*(*ty++);
471    }
472    /**
473     * Set the TrkTrack Student parameter (resx,resy,tailx,taily)
474     * from previous gausian fit
475     *@param flag =0 standard, =1 with noise correction
476     */
477    void TrkTrack::SetStudentParam(int flag){
478        float sx[11]={0.000128242,
479                       0.000136942,
480                       0.000162718,
481                       0.000202644,
482                       0.00025597,
483                       0.000317456,
484                       0.000349048,
485                       0.000384638,
486                       0.000457295,
487                       0.000512319,
488                       0.000538573};
489        float tx[11]={1.79402,
490                       2.04876,
491                       2.88376,
492                       3.3,
493                       3.14084,
494                       4.07686,
495                       4.44736,
496                       3.5179,
497                       3.38697,
498                       3.45739,
499                       3.18627};
500        float sy[11]={0.000483075,
501                       0.000466925,
502                       0.000431658,
503                       0.000428317,
504                       0.000433854,
505                       0.000444044,
506                       0.000482098,
507                       0.000537579,
508                       0.000636279,
509                       0.000741998,
510                       0.000864261};
511        float ty[11]={0.997032,
512                       1.11147,
513                       1.18526,
514                       1.61404,
515                       2.21908,
516                       3.08959,
517                       4.48833,
518                       4.42687,
519                       4.65253,
520                       4.52043,
521                       4.29926};
522        int index;
523        float fact;
524        for(int i=0; i<6; i++) {
525            index = int((fabs(axv[i])+1.)/2.);
526            if(index>10) index=10;
527            tailx[i]=tx[index];
528            if(flag==1) {
529                if(fabs(axv[i])<=10.) fact = resx[i]/risxeta2_(&(axv[i]));
530                if(fabs(axv[i])>10.&&fabs(axv[i])<=15.) fact = resx[i]/risxeta3_(&(axv[i]));
531                if(fabs(axv[i])>15.) fact = resx[i]/risxeta4_(&(axv[i]));
532            } else fact = 1.;
533            resx[i] = sx[index]*fact;
534        }
535        for(int i=0; i<6; i++) {
536            index = int((fabs(ayv[i])+1.)/2.);
537            if(index>10) index=10;
538            taily[i]=ty[index];
539            if(flag==1) fact = resy[i]/risyeta2_(&(ayv[i]));
540            else fact = 1.;
541            resy[i] = sy[index]*fact;
542        }
543    }
544    /**
545     * Set the TrkTrack good measurement
546   */   */
547  void TrkTrack::SetGood(int *xg, int *yg){  void TrkTrack::SetGood(int *xg, int *yg){
548    
# Line 468  void TrkTrack::FillMiniStruct(cMini2trac Line 604  void TrkTrack::FillMiniStruct(cMini2trac
604                    
605          track.resx[i]=resx[i];          track.resx[i]=resx[i];
606          track.resy[i]=resy[i];          track.resy[i]=resy[i];
607            track.tailx[i]=tailx[i];
608            track.taily[i]=taily[i];
609      }      }
610    
611      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 661  void TrkTrack::SetFromMiniStruct(cMini2t
661   *   *
662   * @see TrkParams::SetPFA(int)   * @see TrkParams::SetPFA(int)
663   */   */
664  void TrkTrack::EvaluateClusterPositions(){  Bool_t TrkTrack::EvaluateClusterPositions(){
665            
666  //     cout << "void TrkTrack::GetClusterPositions() "<<endl;  //     cout << "void TrkTrack::GetClusterPositions() "<<endl;
667    
668      TrkParams::Load( );      TrkParams::Load( );
669      if( !TrkParams::IsLoaded() )return;      if( !TrkParams::IsLoaded() )return false;
670            
671      for(int ip=0; ip<6; ip++){      for(int ip=0; ip<6; ip++){
672  //      cout << ip<<" ** "<<xm[ip]<<" / "<<ym[ip]<<endl;;  //      cout << ip<<" ** "<<xm[ip]<<" / "<<ym[ip]<<endl;;
# Line 547  void TrkTrack::EvaluateClusterPositions( Line 685  void TrkTrack::EvaluateClusterPositions(
685          float bfy = 10*TrkParams::GetBY(v);//Tesla          float bfy = 10*TrkParams::GetBY(v);//Tesla
686          int ipp=ip+1;          int ipp=ip+1;
687          xyzpam_(&ipp,&icx,&icy,&ladder,&sensor,&ax,&ay,&bfx,&bfy);          xyzpam_(&ipp,&icx,&icy,&ladder,&sensor,&ax,&ay,&bfx,&bfy);
688            if(icx<0 || icy<0)return false;
689      }      }
690        return true;
691  }  }
692  /**  /**
693   * \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 725  void TrkTrack::Fit(double pfixed, int& f
725    
726      extern cMini2track track_;      extern cMini2track track_;
727      fail = 0;      fail = 0;
728    
729      FillMiniStruct(track_);      FillMiniStruct(track_);
730                
731      if(froml1!=0)EvaluateClusterPositions();      if(froml1!=0){
732            if( !EvaluateClusterPositions() ){
733                cout << "void TrkTrack::Fit("<<pfixed<<","<<fail<<","<<iprint<<","<<froml1<<") --- ERROR evaluating cluster positions "<<endl;
734                FillMiniStruct(track_) ;
735                fail = 1;
736                return;
737            }
738        }else{
739            FillMiniStruct(track_);
740        }
741            
742      // if fit variables have been reset, evaluate the initial guess      // if fit variables have been reset, evaluate the initial guess
743      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 810  void TrkTrack::SetPrecisionFactor(double
810      track_.fact = fact;      track_.fact = fact;
811  }  }
812  /**  /**
813   * Set the factor scale for tracking precision   * Set the minimum number of steps for tracking precision
814   */   */
815  void TrkTrack::SetStepMin(int istepmin){  void TrkTrack::SetStepMin(int istepmin){
816      extern cMini2track track_;      extern cMini2track track_;
817      track_.istepmin = istepmin;      track_.istepmin = istepmin;
818  }  }
819    /**
820     * Returns 1 if the track is inside the magnet cavity
821     * Set the minimum number of steps for tracking precision
822     */
823    Bool_t TrkTrack::IsInsideCavity(){
824        float xmagntop, ymagntop, xmagnbottom, ymagnbottom;
825        xmagntop = xv[0] + (ZMAGNHIGH-zv[0])*tan(cos(-1.0)*axv[0]/180.);
826        ymagntop = yv[0] + (ZMAGNHIGH-zv[0])*tan(cos(-1.0)*ayv[0]/180.);
827        xmagnbottom = xv[5] + (ZMAGNLOW-zv[5])*tan(cos(-1.0)*axv[5]/180.);
828        ymagnbottom = yv[5] + (ZMAGNLOW-zv[5])*tan(cos(-1.0)*ayv[5]/180.);
829        if( xmagntop>XMAGNLOW && xmagntop<XMAGNHIGH &&
830            ymagntop>YMAGNLOW && ymagntop<YMAGNHIGH &&
831            xmagnbottom>XMAGNLOW && xmagnbottom<XMAGNHIGH &&
832            ymagnbottom>YMAGNLOW && ymagnbottom<YMAGNHIGH ) return(true);
833        else return(false);
834    }
835  /**  /**
836   * 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.
837   * If no cluster is associated, ID=-1.   * If no cluster is associated, ID=-1.
# Line 884  void TrkLevel2::Dump(){ Line 1048  void TrkLevel2::Dump(){
1048          for(int i=0; i<nclsy(); i++) ((TrkSinglet *)sy[i])->Dump();          for(int i=0; i<nclsy(); i++) ((TrkSinglet *)sy[i])->Dump();
1049      }      }
1050  }  }
1051    /**
1052     * \brief Dump processing status
1053     */
1054    void TrkLevel2::StatusDump(int view){
1055        cout << "DSP n. "<<view+1<<" status: "<<hex<<good[view]<<endl;    
1056    };
1057    /**
1058     * \brief Check event status
1059     *
1060     * Check the event status, according to a flag-mask given as input.
1061     * Return true if the view passes the check.
1062     *
1063     * @param view View number (0-11)
1064     * @param flagmask Mask of flags to check (eg. flagmask=0x111 no missing packet,
1065     *  no crc error, no software alarm)
1066     *
1067     * @see TrkLevel2 class definition to know how the status flag is defined
1068     *
1069     */
1070    Bool_t TrkLevel2::StatusCheck(int view, int flagmask){
1071    
1072        if( view<0 || view >= 12)return false;
1073        return !(good[view]&flagmask);
1074    
1075    };
1076    
1077    
1078  //--------------------------------------  //--------------------------------------
1079  //  //
1080  //  //
Legend:
Removed from v.1.33  
changed lines
  Added in v.1.37
  ViewVC Help
Powered by ViewVC 1.1.23