/[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.38 by pam-fi, Fri Aug 17 13:25:14 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  //  //
426  //  //
# Line 381  void TrkTrack::Dump(){ Line 442  void TrkTrack::Dump(){
442      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] << " ";
443      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] << " ";
444      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] << " ";
445        cout << endl << "tailx    : "; for(int i=0; i<6; i++)cout << tailx[i] << " ";
446        cout << endl << "taily    : "; for(int i=0; i<6; i++)cout << taily[i] << " ";
447      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]<<" ";
448      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]<<" ";
449      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 469  void TrkTrack::SetResolution(double *rx,
469      for(int i=0; i<6; i++) resy[i]=*ry++;      for(int i=0; i<6; i++) resy[i]=*ry++;
470  }  }
471  /**  /**
472   * Set the TrkTrack good measurement.   * Set the TrkTrack tails position resolution
473     */
474    void TrkTrack::SetTail(double *tx, double *ty, double factor){
475        for(int i=0; i<6; i++) tailx[i]=factor*(*tx++);
476        for(int i=0; i<6; i++) taily[i]=factor*(*ty++);
477    }
478    /**
479     * Set the TrkTrack Student parameter (resx,resy,tailx,taily)
480     * from previous gausian fit
481     *@param flag =0 standard, =1 with noise correction
482     */
483    void TrkTrack::SetStudentParam(int flag){
484        float sx[11]={0.000128242,
485                       0.000136942,
486                       0.000162718,
487                       0.000202644,
488                       0.00025597,
489                       0.000317456,
490                       0.000349048,
491                       0.000384638,
492                       0.000457295,
493                       0.000512319,
494                       0.000538573};
495        float tx[11]={1.79402,
496                       2.04876,
497                       2.88376,
498                       3.3,
499                       3.14084,
500                       4.07686,
501                       4.44736,
502                       3.5179,
503                       3.38697,
504                       3.45739,
505                       3.18627};
506        float sy[11]={0.000483075,
507                       0.000466925,
508                       0.000431658,
509                       0.000428317,
510                       0.000433854,
511                       0.000444044,
512                       0.000482098,
513                       0.000537579,
514                       0.000636279,
515                       0.000741998,
516                       0.000864261};
517        float ty[11]={0.997032,
518                       1.11147,
519                       1.18526,
520                       1.61404,
521                       2.21908,
522                       3.08959,
523                       4.48833,
524                       4.42687,
525                       4.65253,
526                       4.52043,
527                       4.29926};
528        int index;
529        float fact;
530        for(int i=0; i<6; i++) {
531            index = int((fabs(axv[i])+1.)/2.);
532            if(index>10) index=10;
533            tailx[i]=tx[index];
534            if(flag==1) {
535                if(fabs(axv[i])<=10.) fact = resx[i]/risxeta2_(&(axv[i]));
536                if(fabs(axv[i])>10.&&fabs(axv[i])<=15.) fact = resx[i]/risxeta3_(&(axv[i]));
537                if(fabs(axv[i])>15.) fact = resx[i]/risxeta4_(&(axv[i]));
538            } else fact = 1.;
539            resx[i] = sx[index]*fact;
540        }
541        for(int i=0; i<6; i++) {
542            index = int((fabs(ayv[i])+1.)/2.);
543            if(index>10) index=10;
544            taily[i]=ty[index];
545            if(flag==1) fact = resy[i]/risyeta2_(&(ayv[i]));
546            else fact = 1.;
547            resy[i] = sy[index]*fact;
548        }
549    }
550    /**
551     * Set the TrkTrack good measurement
552   */   */
553  void TrkTrack::SetGood(int *xg, int *yg){  void TrkTrack::SetGood(int *xg, int *yg){
554    
# Line 468  void TrkTrack::FillMiniStruct(cMini2trac Line 610  void TrkTrack::FillMiniStruct(cMini2trac
610                    
611          track.resx[i]=resx[i];          track.resx[i]=resx[i];
612          track.resy[i]=resy[i];          track.resy[i]=resy[i];
613            track.tailx[i]=tailx[i];
614            track.taily[i]=taily[i];
615      }      }
616    
617      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 667  void TrkTrack::SetFromMiniStruct(cMini2t
667   *   *
668   * @see TrkParams::SetPFA(int)   * @see TrkParams::SetPFA(int)
669   */   */
670  void TrkTrack::EvaluateClusterPositions(){  Bool_t TrkTrack::EvaluateClusterPositions(){
671            
672  //     cout << "void TrkTrack::GetClusterPositions() "<<endl;  //     cout << "void TrkTrack::GetClusterPositions() "<<endl;
673    
674      TrkParams::Load( );      TrkParams::Load( );
675      if( !TrkParams::IsLoaded() )return;      if( !TrkParams::IsLoaded() )return false;
676            
677      for(int ip=0; ip<6; ip++){      for(int ip=0; ip<6; ip++){
678  //      cout << ip<<" ** "<<xm[ip]<<" / "<<ym[ip]<<endl;;  //      cout << ip<<" ** "<<xm[ip]<<" / "<<ym[ip]<<endl;;
# Line 547  void TrkTrack::EvaluateClusterPositions( Line 691  void TrkTrack::EvaluateClusterPositions(
691          float bfy = 10*TrkParams::GetBY(v);//Tesla          float bfy = 10*TrkParams::GetBY(v);//Tesla
692          int ipp=ip+1;          int ipp=ip+1;
693          xyzpam_(&ipp,&icx,&icy,&ladder,&sensor,&ax,&ay,&bfx,&bfy);          xyzpam_(&ipp,&icx,&icy,&ladder,&sensor,&ax,&ay,&bfx,&bfy);
694            if(icx<0 || icy<0)return false;
695      }      }
696        return true;
697  }  }
698  /**  /**
699   * \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 731  void TrkTrack::Fit(double pfixed, int& f
731    
732      extern cMini2track track_;      extern cMini2track track_;
733      fail = 0;      fail = 0;
734    
735      FillMiniStruct(track_);      FillMiniStruct(track_);
736                
737      if(froml1!=0)EvaluateClusterPositions();      if(froml1!=0){
738            if( !EvaluateClusterPositions() ){
739                cout << "void TrkTrack::Fit("<<pfixed<<","<<fail<<","<<iprint<<","<<froml1<<") --- ERROR evaluating cluster positions "<<endl;
740                FillMiniStruct(track_) ;
741                fail = 1;
742                return;
743            }
744        }else{
745            FillMiniStruct(track_);
746        }
747            
748      // if fit variables have been reset, evaluate the initial guess      // if fit variables have been reset, evaluate the initial guess
749      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 816  void TrkTrack::SetPrecisionFactor(double
816      track_.fact = fact;      track_.fact = fact;
817  }  }
818  /**  /**
819   * Set the factor scale for tracking precision   * Set the minimum number of steps for tracking precision
820   */   */
821  void TrkTrack::SetStepMin(int istepmin){  void TrkTrack::SetStepMin(int istepmin){
822      extern cMini2track track_;      extern cMini2track track_;
823      track_.istepmin = istepmin;      track_.istepmin = istepmin;
824  }  }
825    /**
826     * Returns 1 if the track is inside the magnet cavity
827     * Set the minimum number of steps for tracking precision
828     */
829    Bool_t TrkTrack::IsInsideCavity(){
830        float xmagntop, ymagntop, xmagnbottom, ymagnbottom;
831        xmagntop = xv[0] + (ZMAGNHIGH-zv[0])*tan(cos(-1.0)*axv[0]/180.);
832        ymagntop = yv[0] + (ZMAGNHIGH-zv[0])*tan(cos(-1.0)*ayv[0]/180.);
833        xmagnbottom = xv[5] + (ZMAGNLOW-zv[5])*tan(cos(-1.0)*axv[5]/180.);
834        ymagnbottom = yv[5] + (ZMAGNLOW-zv[5])*tan(cos(-1.0)*ayv[5]/180.);
835        if( xmagntop>XMAGNLOW && xmagntop<XMAGNHIGH &&
836            ymagntop>YMAGNLOW && ymagntop<YMAGNHIGH &&
837            xmagnbottom>XMAGNLOW && xmagnbottom<XMAGNHIGH &&
838            ymagnbottom>YMAGNLOW && ymagnbottom<YMAGNHIGH ) return(true);
839        else return(false);
840    }
841  /**  /**
842   * 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.
843   * If no cluster is associated, ID=-1.   * If no cluster is associated, ID=-1.
# Line 884  void TrkLevel2::Dump(){ Line 1054  void TrkLevel2::Dump(){
1054          for(int i=0; i<nclsy(); i++) ((TrkSinglet *)sy[i])->Dump();          for(int i=0; i<nclsy(); i++) ((TrkSinglet *)sy[i])->Dump();
1055      }      }
1056  }  }
1057    /**
1058     * \brief Dump processing status
1059     */
1060    void TrkLevel2::StatusDump(int view){
1061        cout << "DSP n. "<<view+1<<" status: "<<hex<<good[view]<<endl;    
1062    };
1063    /**
1064     * \brief Check event status
1065     *
1066     * Check the event status, according to a flag-mask given as input.
1067     * Return true if the view passes the check.
1068     *
1069     * @param view View number (0-11)
1070     * @param flagmask Mask of flags to check (eg. flagmask=0x111 no missing packet,
1071     *  no crc error, no software alarm)
1072     *
1073     * @see TrkLevel2 class definition to know how the status flag is defined
1074     *
1075     */
1076    Bool_t TrkLevel2::StatusCheck(int view, int flagmask){
1077    
1078        if( view<0 || view >= 12)return false;
1079        return !(good[view]&flagmask);
1080    
1081    };
1082    
1083    
1084  //--------------------------------------  //--------------------------------------
1085  //  //
1086  //  //
Legend:
Removed from v.1.33  
changed lines
  Added in v.1.38
  ViewVC Help
Powered by ViewVC 1.1.23