--- DarthVader/TrackerLevel2/src/TrkLevel2.cpp	2007/05/14 11:03:05	1.33
+++ DarthVader/TrackerLevel2/src/TrkLevel2.cpp	2007/06/06 09:36:07	1.37
@@ -12,8 +12,13 @@
 extern "C" {    
     void dotrack_(int*, double*, double*, double*, double*, int*);
     void dotrack2_(int*, double*, double*, double*, double*,double*, double*, double*,int*);
-     void mini2_(int*,int*,int*); 
-     void guess_();
+    void mini2_(int*,int*,int*); 
+    void guess_();
+    void gufld_(float*, float*);
+    float risxeta2_(float *);
+    float risxeta3_(float *);
+    float risxeta4_(float *);
+    float risyeta2_(float *);
 }
 
 //--------------------------------------
@@ -360,6 +365,56 @@
     }
     return (last_plane-first_plane+1);
 }
+/**
+ * Returns the reduced chi-square of track x-projection
+ */
+Float_t  TrkTrack::GetChi2X(){
+    float chiq=0;
+    for(int ip=0; ip<6; ip++)if(XGood(ip))chiq+= pow((xv[ip]-xm[ip])/resx[ip],2.); 
+    if(GetNX()>3)chiq=chiq/(GetNX()-3);
+    else chiq=0;
+    if(chiq==0)cout << " Float_t  TrkTrack::GetChi2X() -- WARNING -- value not defined "<<chiq<<endl;
+    return chiq;
+}
+/**
+ * Returns the reduced chi-square of track y-projection
+ */
+Float_t  TrkTrack::GetChi2Y(){
+    float chiq=0;
+    for(int ip=0; ip<6; ip++)if(YGood(ip))chiq+= pow((yv[ip]-ym[ip])/resy[ip],2.); 
+    if(GetNY()>2)chiq=chiq/(GetNY()-2);
+    else chiq=0;
+    if(chiq==0)cout << " Float_t  TrkTrack::GetChi2Y() -- WARNING -- value not defined "<<chiq<<endl;
+    return chiq;
+}
+/**
+ * Returns the logarythm of the likeliwood-function of  track x-projection
+ */
+Float_t TrkTrack::GetLnLX(){
+    float lnl=0;
+    for(int ip=0; ip<6; ip++)
+	if( XGood(ip) && tailx[ip]!=0 )
+	    lnl += (tailx[ip]+1.) * log( (tailx[ip]*pow(resx[ip],2.) + pow(xv[ip]-xm[ip],2.)) / (tailx[ip]*pow(resx[ip],2)) ); 
+    if(GetNX()>3)lnl=lnl/(GetNX()-3);
+    else lnl=0;
+    if(lnl==0)cout << " Float_t  TrkTrack::GetLnLX() -- WARNING -- value not defined "<<lnl<<endl;
+    return lnl;
+    
+}
+/**
+ * Returns the logarythm of the likeliwood-function of  track y-projection
+ */
+Float_t TrkTrack::GetLnLY(){
+    float lnl=0;
+    for(int ip=0; ip<6; ip++)
+	if( YGood(ip) && taily[ip]!=0 )
+	    lnl += (taily[ip]+1.) * log( (taily[ip]*pow(resy[ip],2.) + pow(yv[ip]-ym[ip],2.)) / (taily[ip]*pow(resy[ip],2)) ); 
+    if(GetNY()>2)lnl=lnl/(GetNY()-2);
+    else lnl=0;
+    if(lnl==0)cout << " Float_t  TrkTrack::GetLnLY() -- WARNING -- value not defined "<<lnl<<endl;
+    return lnl;
+    
+}
 //--------------------------------------
 //
 //
@@ -381,6 +436,8 @@
     cout << endl << "zv       : "; for(int i=0; i<6; i++)cout << zv[i] << " ";
     cout << endl << "resx     : "; for(int i=0; i<6; i++)cout << resx[i] << " ";
     cout << endl << "resy     : "; for(int i=0; i<6; i++)cout << resy[i] << " ";
+    cout << endl << "tailx    : "; for(int i=0; i<6; i++)cout << tailx[i] << " ";
+    cout << endl << "taily    : "; for(int i=0; i<6; i++)cout << taily[i] << " ";
     cout << endl << "coval    : "; for(int i=0; i<5; i++)cout << coval[0][i]<<" ";
     cout << endl << "           "; for(int i=0; i<5; i++)cout << coval[1][i]<<" ";
     cout << endl << "           "; for(int i=0; i<5; i++)cout << coval[2][i]<<" ";
@@ -406,7 +463,86 @@
     for(int i=0; i<6; i++) resy[i]=*ry++;
 }
 /**
- * Set the TrkTrack good measurement.
+ * Set the TrkTrack tails position resolution 
+ */
+void TrkTrack::SetTail(double *tx, double *ty, double factor){
+    for(int i=0; i<6; i++) tailx[i]=factor*(*tx++);
+    for(int i=0; i<6; i++) taily[i]=factor*(*ty++);
+}
+/**
+ * Set the TrkTrack Student parameter (resx,resy,tailx,taily)
+ * from previous gausian fit
+ *@param flag =0 standard, =1 with noise correction 
+ */
+void TrkTrack::SetStudentParam(int flag){
+    float sx[11]={0.000128242,
+		   0.000136942,
+		   0.000162718,
+		   0.000202644,
+		   0.00025597,
+		   0.000317456,
+		   0.000349048,
+		   0.000384638,
+		   0.000457295,
+		   0.000512319,
+		   0.000538573};
+    float tx[11]={1.79402,
+		   2.04876,
+		   2.88376,
+		   3.3,
+		   3.14084,
+		   4.07686,
+		   4.44736,
+		   3.5179,
+		   3.38697,
+		   3.45739,
+		   3.18627};
+    float sy[11]={0.000483075,
+		   0.000466925,
+		   0.000431658,
+		   0.000428317,
+		   0.000433854,
+		   0.000444044,
+		   0.000482098,
+		   0.000537579,
+		   0.000636279,
+		   0.000741998,
+		   0.000864261};
+    float ty[11]={0.997032,
+		   1.11147,
+		   1.18526,
+		   1.61404,
+		   2.21908,
+		   3.08959,
+		   4.48833,
+		   4.42687,
+		   4.65253,
+		   4.52043,
+		   4.29926};
+    int index;
+    float fact;
+    for(int i=0; i<6; i++) {
+	index = int((fabs(axv[i])+1.)/2.);
+	if(index>10) index=10;
+	tailx[i]=tx[index];
+	if(flag==1) {
+	    if(fabs(axv[i])<=10.) fact = resx[i]/risxeta2_(&(axv[i]));
+	    if(fabs(axv[i])>10.&&fabs(axv[i])<=15.) fact = resx[i]/risxeta3_(&(axv[i]));
+	    if(fabs(axv[i])>15.) fact = resx[i]/risxeta4_(&(axv[i]));
+	} else fact = 1.;
+	resx[i] = sx[index]*fact;
+    }
+    for(int i=0; i<6; i++) {
+	index = int((fabs(ayv[i])+1.)/2.);
+	if(index>10) index=10;
+	taily[i]=ty[index];
+	if(flag==1) fact = resy[i]/risyeta2_(&(ayv[i]));
+	else fact = 1.;
+	resy[i] = sy[index]*fact;
+    }
+}
+/**
+ * Set the TrkTrack good measurement 
  */
 void TrkTrack::SetGood(int *xg, int *yg){
 
@@ -468,6 +604,8 @@
 	
 	track.resx[i]=resx[i];
 	track.resy[i]=resy[i];
+	track.tailx[i]=tailx[i];
+	track.taily[i]=taily[i];
     }
 
     for(int i=0; i<5; i++) track.al[i]=al[i]; 
@@ -523,12 +661,12 @@
  *
  * @see TrkParams::SetPFA(int)
  */
-void TrkTrack::EvaluateClusterPositions(){
+Bool_t TrkTrack::EvaluateClusterPositions(){
     
 //     cout << "void TrkTrack::GetClusterPositions() "<<endl;
 
     TrkParams::Load( );
-    if( !TrkParams::IsLoaded() )return;
+    if( !TrkParams::IsLoaded() )return false;
     
     for(int ip=0; ip<6; ip++){
 //	cout << ip<<" ** "<<xm[ip]<<" / "<<ym[ip]<<endl;;
@@ -547,7 +685,9 @@
 	float bfy = 10*TrkParams::GetBY(v);//Tesla
 	int ipp=ip+1;
 	xyzpam_(&ipp,&icx,&icy,&ladder,&sensor,&ax,&ay,&bfx,&bfy);
+	if(icx<0 || icy<0)return false;
     }
+    return true;
 }
 /**
  * \brief Tracking method. It calls F77 mini routine.
@@ -585,9 +725,19 @@
 
     extern cMini2track track_;
     fail = 0;
+
     FillMiniStruct(track_);
-    
-    if(froml1!=0)EvaluateClusterPositions();
+        
+    if(froml1!=0){
+	if( !EvaluateClusterPositions() ){
+	    cout << "void TrkTrack::Fit("<<pfixed<<","<<fail<<","<<iprint<<","<<froml1<<") --- ERROR evaluating cluster positions "<<endl;
+	    FillMiniStruct(track_) ;
+	    fail = 1;
+	    return;
+	}
+    }else{
+	FillMiniStruct(track_);	
+    }
     
     // if fit variables have been reset, evaluate the initial guess
     if(al[0]==-9999.&&al[1]==-9999.&&al[2]==-9999.&&al[3]==-9999.&&al[4]==-9999.)guess_();
@@ -660,14 +810,28 @@
     track_.fact = fact;
 }
 /**
- * Set the factor scale for tracking precision 
+ * Set the minimum number of steps for tracking precision 
  */
 void TrkTrack::SetStepMin(int istepmin){
     extern cMini2track track_;
     track_.istepmin = istepmin;
 }
-
-
+/**
+ * Returns 1 if the track is inside the magnet cavity
+ * Set the minimum number of steps for tracking precision 
+ */
+Bool_t TrkTrack::IsInsideCavity(){
+    float xmagntop, ymagntop, xmagnbottom, ymagnbottom;
+    xmagntop = xv[0] + (ZMAGNHIGH-zv[0])*tan(cos(-1.0)*axv[0]/180.);
+    ymagntop = yv[0] + (ZMAGNHIGH-zv[0])*tan(cos(-1.0)*ayv[0]/180.);
+    xmagnbottom = xv[5] + (ZMAGNLOW-zv[5])*tan(cos(-1.0)*axv[5]/180.);
+    ymagnbottom = yv[5] + (ZMAGNLOW-zv[5])*tan(cos(-1.0)*ayv[5]/180.);
+    if( xmagntop>XMAGNLOW && xmagntop<XMAGNHIGH &&
+	ymagntop>YMAGNLOW && ymagntop<YMAGNHIGH &&
+	xmagnbottom>XMAGNLOW && xmagnbottom<XMAGNHIGH &&
+	ymagnbottom>YMAGNLOW && ymagnbottom<YMAGNHIGH ) return(true);
+    else return(false);
+}
 /**
  * Method to retrieve ID (0,1,...) of x-cluster (if any) associated to this track.
  * If no cluster is associated, ID=-1.
@@ -884,6 +1048,33 @@
 	for(int i=0; i<nclsy(); i++) ((TrkSinglet *)sy[i])->Dump();
     }
 }
+/**
+ * \brief Dump processing status
+ */
+void TrkLevel2::StatusDump(int view){
+    cout << "DSP n. "<<view+1<<" status: "<<hex<<good[view]<<endl;    
+};
+/**
+ * \brief Check event status
+ *
+ * Check the event status, according to a flag-mask given as input. 
+ * Return true if the view passes the check.
+ * 
+ * @param view View number (0-11)
+ * @param flagmask Mask of flags to check (eg. flagmask=0x111 no missing packet, 
+ *  no crc error, no software alarm)
+ *
+ * @see TrkLevel2 class definition to know how the status flag is defined
+ *
+ */
+Bool_t TrkLevel2::StatusCheck(int view, int flagmask){
+
+    if( view<0 || view >= 12)return false;
+    return !(good[view]&flagmask);
+
+};
+
+
 //--------------------------------------
 //
 //