00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018 using namespace std;
00019
00020 #include <iostream>
00021 #include "FWCore/MessageLogger/interface/MessageLogger.h"
00022 #include "PhysicsTools/KinFitter/interface/TFitParticleEtThetaPhi.h"
00023 #include "TMath.h"
00024
00025 ClassImp(TFitParticleEtThetaPhi)
00026
00027
00028
00029
00030 TFitParticleEtThetaPhi::TFitParticleEtThetaPhi()
00031 :TAbsFitParticle()
00032 {
00033 init(0, 0);
00034 }
00035
00036 TFitParticleEtThetaPhi::TFitParticleEtThetaPhi( const TFitParticleEtThetaPhi& fitParticle )
00037 :TAbsFitParticle( fitParticle.GetName(), fitParticle.GetTitle() )
00038 {
00039
00040 _nPar = fitParticle._nPar;
00041 _u1 = fitParticle._u1;
00042 _u2 = fitParticle._u2;
00043 _u3 = fitParticle._u3;
00044 _covMatrix.ResizeTo( fitParticle._covMatrix );
00045 _covMatrix = fitParticle._covMatrix;
00046 _iniparameters.ResizeTo( fitParticle._iniparameters );
00047 _iniparameters = fitParticle._iniparameters;
00048 _parameters.ResizeTo( fitParticle._parameters );
00049 _parameters = fitParticle._parameters;
00050 _pini = fitParticle._pini;
00051 _pcurr = fitParticle._pcurr;
00052
00053 }
00054
00055 TFitParticleEtThetaPhi::TFitParticleEtThetaPhi(TLorentzVector* pini, const TMatrixD* theCovMatrix)
00056 :TAbsFitParticle()
00057 {
00058 init(pini, theCovMatrix);
00059 }
00060
00061 TFitParticleEtThetaPhi::TFitParticleEtThetaPhi(const TString &name, const TString &title,
00062 TLorentzVector* pini, const TMatrixD* theCovMatrix)
00063 :TAbsFitParticle(name, title)
00064 {
00065 init(pini, theCovMatrix);
00066 }
00067
00068 TAbsFitParticle* TFitParticleEtThetaPhi::clone( TString newname ) const {
00069
00070
00071 TAbsFitParticle* myclone = new TFitParticleEtThetaPhi( *this );
00072 if ( newname.Length() > 0 ) myclone->SetName(newname);
00073 return myclone;
00074
00075 }
00076
00077
00078
00079
00080 TFitParticleEtThetaPhi::~TFitParticleEtThetaPhi() {
00081
00082 }
00083
00084
00085
00086
00087 void TFitParticleEtThetaPhi::init(TLorentzVector* pini, const TMatrixD* theCovMatrix ) {
00088
00089 _nPar = 3;
00090 setIni4Vec(pini);
00091 setCovMatrix(theCovMatrix);
00092
00093 }
00094
00095 TLorentzVector* TFitParticleEtThetaPhi::calc4Vec( const TMatrixD* params ) {
00096
00097
00098
00099 if (params == 0) {
00100 return 0;
00101 }
00102
00103 if ( params->GetNcols() != 1 || params->GetNrows() !=_nPar ) {
00104 edm::LogError ("WrongMatrixSize")
00105 << GetName() << "::calc4Vec - Parameter matrix has wrong size.";
00106 return 0;
00107 }
00108
00109 Double_t et = (*params)(0,0);
00110 Double_t theta = (*params)(1,0);
00111 Double_t phi = (*params)(2,0);
00112
00113 Double_t X = et*TMath::Cos(phi);
00114 Double_t Y = et*TMath::Sin(phi);
00115 Double_t Z = et/TMath::Tan(theta);
00116 Double_t E = et/TMath::Sin(theta);
00117
00118 TLorentzVector* vec = new TLorentzVector( X, Y, Z, E );
00119 return vec;
00120
00121 }
00122
00123 void TFitParticleEtThetaPhi::setIni4Vec(const TLorentzVector* pini) {
00124
00125
00126
00127 if (pini == 0) {
00128
00129 _u1.SetXYZ(0., 0., 0.);
00130 _u3.SetXYZ(0., 0., 0.);
00131 _u2.SetXYZ(0., 0., 0.);
00132 _pini.SetXYZT(0., 0., 0., 0.);
00133 _pcurr = _pini;
00134
00135 _iniparameters.ResizeTo(_nPar,1);
00136 _iniparameters(0,0) = 0.;
00137 _iniparameters(1,0) = 0.;
00138 _iniparameters(2,0) = 0.;
00139
00140 _parameters.ResizeTo(_nPar,1);
00141 _parameters(0,0) = 0.;
00142 _parameters(1,0) = 0.;
00143 _parameters(2,0) = 0.;
00144
00145 } else {
00146
00147 Double_t et = pini->E()*fabs(sin(pini->Theta()));
00148 Double_t theta = pini->Theta();
00149 Double_t phi = pini->Phi();
00150
00151 _pini = (*pini);
00152 _pcurr = _pini;
00153
00154 _iniparameters.ResizeTo(_nPar,1);
00155 _iniparameters(0,0) = et;
00156 _iniparameters(1,0) = theta;
00157 _iniparameters(2,0) = phi;
00158
00159 _parameters.ResizeTo(_nPar,1);
00160 _parameters = _iniparameters;
00161
00162 _u1.SetXYZ( TMath::Cos(phi), TMath::Sin(phi), 0.);
00163 _u2.SetXYZ( TMath::Cos(phi)*TMath::Cos(theta), TMath::Sin(phi)*TMath::Cos(theta), -1.*TMath::Sin(theta) );
00164 _u3.SetXYZ( -1.*TMath::Sin(phi), TMath::Cos(phi), 0. );
00165
00166 }
00167
00168 }
00169
00170 TMatrixD* TFitParticleEtThetaPhi::getDerivative() {
00171
00172
00173
00174
00175 TMatrixD* DerivativeMatrix = new TMatrixD(4,3);
00176 (*DerivativeMatrix) *= 0.;
00177
00178 Double_t et = _parameters(0,0);
00179 Double_t theta = _parameters(1,0);
00180 Double_t phi = _parameters(2,0);
00181
00182 Double_t CotanTheta = 1./TMath::Tan(theta);
00183
00184
00185 (*DerivativeMatrix)(0,0) = TMath::Cos(phi);
00186 (*DerivativeMatrix)(1,0) = TMath::Sin(phi);
00187 (*DerivativeMatrix)(2,0) = CotanTheta;
00188 (*DerivativeMatrix)(3,0) = 1./TMath::Sin(theta);
00189
00190
00191 (*DerivativeMatrix)(0,1) = 0.;
00192 (*DerivativeMatrix)(1,1) = 0.;
00193 (*DerivativeMatrix)(2,1) = -1.*et*(1.+CotanTheta*CotanTheta);
00194 (*DerivativeMatrix)(3,1) = -1.*et*CotanTheta/(TMath::Sin(theta));
00195
00196
00197 (*DerivativeMatrix)(0,2) = -1.*et*TMath::Sin(phi);
00198 (*DerivativeMatrix)(1,2) = et*TMath::Cos(phi);
00199 (*DerivativeMatrix)(2,2) = 0.;
00200 (*DerivativeMatrix)(3,2) = 0.;
00201
00202 return DerivativeMatrix;
00203
00204 }
00205
00206 TMatrixD* TFitParticleEtThetaPhi::transform(const TLorentzVector& vec) {
00207
00208
00209
00210
00211 TMatrixD* tparams = new TMatrixD( _nPar, 1 );
00212 (*tparams)(0,0) = vec.E()*fabs(sin(vec.Theta()));
00213 (*tparams)(1,0) = vec.Theta();
00214 (*tparams)(2,0) = vec.Phi();
00215
00216 return tparams;
00217
00218 }