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/TFitParticleMCSpher.h"
00023 #include "TMath.h"
00024
00025 ClassImp(TFitParticleMCSpher)
00026
00027
00028
00029
00030 TFitParticleMCSpher::TFitParticleMCSpher()
00031 :TAbsFitParticle()
00032 {
00033 init( 0, 0., 0);
00034 }
00035
00036 TFitParticleMCSpher::TFitParticleMCSpher( const TFitParticleMCSpher& 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 TFitParticleMCSpher::TFitParticleMCSpher(TVector3* p, Double_t M, const TMatrixD* theCovMatrix)
00056 :TAbsFitParticle()
00057 {
00058 init(p, M, theCovMatrix);
00059 }
00060
00061 TFitParticleMCSpher::TFitParticleMCSpher(const TString &name, const TString &title,
00062 TVector3* p, Double_t M, const TMatrixD* theCovMatrix)
00063 :TAbsFitParticle(name, title)
00064 {
00065 init(p, M, theCovMatrix);
00066 }
00067
00068 TAbsFitParticle* TFitParticleMCSpher::clone( TString newname ) const {
00069
00070
00071 TAbsFitParticle* myclone = new TFitParticleMCSpher( *this );
00072 if ( newname.Length() > 0 ) myclone->SetName(newname);
00073 return myclone;
00074
00075 }
00076
00077
00078
00079
00080 TFitParticleMCSpher::~TFitParticleMCSpher() {
00081
00082 }
00083
00084
00085
00086
00087
00088 void TFitParticleMCSpher::init(TVector3* p, Double_t M, const TMatrixD* theCovMatrix) {
00089
00090 _nPar = 3;
00091 setIni4Vec(p, M);
00092 setCovMatrix(theCovMatrix);
00093
00094 }
00095
00096 TLorentzVector* TFitParticleMCSpher::calc4Vec( const TMatrixD* params ) {
00097
00098
00099
00100 if (params == 0) {
00101 return 0;
00102 }
00103
00104 if ( params->GetNcols() != 1 || params->GetNrows() !=_nPar ) {
00105 edm::LogError ("WrongMatrixSize")
00106 << GetName() << "::calc4Vec - Parameter matrix has wrong size.";
00107 return 0;
00108 }
00109
00110 Double_t r = (*params)(0,0);
00111 Double_t theta = (*params)(1,0);
00112 Double_t phi = (*params)(2,0);
00113
00114 Double_t X = r*TMath::Cos(phi)*TMath::Sin(theta);
00115 Double_t Y = r*TMath::Sin(phi)*TMath::Sin(theta);
00116 Double_t Z = r*TMath::Cos(theta);
00117 Double_t E = TMath::Sqrt( X*X + Y*Y + Z*Z + _pini.M2() );
00118
00119 TLorentzVector* vec = new TLorentzVector( X, Y, Z, E );
00120 return vec;
00121
00122 }
00123
00124 void TFitParticleMCSpher::setIni4Vec(const TLorentzVector* pini) {
00125
00126
00127
00128 TVector3 vec( pini->Vect() );
00129 setIni4Vec( &vec, pini->M() );
00130
00131 }
00132
00133 void TFitParticleMCSpher::setIni4Vec(const TVector3* p, Double_t M) {
00134
00135
00136
00137 if ( p == 0 ) {
00138
00139 _u1.SetXYZ(0., 0., 0.);
00140 _u3.SetXYZ(0., 0., 0.);
00141 _u2.SetXYZ(0., 0., 0.);
00142 _pini.SetXYZM(0., 0., 0., M);
00143 _pcurr = _pini;
00144
00145 _iniparameters.ResizeTo(_nPar,1);
00146 _iniparameters(0,0) = 0.;
00147 _parameters.ResizeTo(_nPar,1);
00148 _parameters = _iniparameters;
00149
00150 } else {
00151
00152 _pini.SetXYZM( p->x(), p->y(), p->z(), M);
00153 _pcurr = _pini;
00154
00155 Double_t r = _pini.P();
00156 Double_t theta = _pini.Theta();
00157 Double_t phi = _pini.Phi();
00158
00159 _iniparameters.ResizeTo(_nPar,1);
00160 _iniparameters(0,0) = r;
00161 _iniparameters(1,0) = theta;
00162 _iniparameters(2,0) = phi;
00163 _parameters.ResizeTo(_nPar,1);
00164 _parameters = _iniparameters;
00165
00166 _u1.SetXYZ( TMath::Cos(phi)*TMath::Sin(theta), TMath::Sin(phi)*TMath::Sin(theta), TMath::Cos(theta) );
00167 _u2.SetXYZ( TMath::Cos(phi)*TMath::Cos(theta), TMath::Sin(phi)*TMath::Cos(theta), -1.*TMath::Sin(theta) );
00168 _u3.SetXYZ( -1.*TMath::Sin(phi), TMath::Cos(phi), 0. );
00169
00170 }
00171
00172 }
00173
00174 TMatrixD* TFitParticleMCSpher::getDerivative() {
00175
00176
00177
00178
00179 TMatrixD* DerivativeMatrix = new TMatrixD(4,3);
00180 (*DerivativeMatrix) *= 0.;
00181
00182 Double_t r = _parameters(0,0);
00183 Double_t theta = _parameters(1,0);
00184 Double_t phi = _parameters(2,0);
00185
00186
00187 (*DerivativeMatrix)(0,0) = TMath::Cos(phi)*TMath::Sin(theta);
00188 (*DerivativeMatrix)(1,0) = TMath::Sin(phi)*TMath::Sin(theta);
00189 (*DerivativeMatrix)(2,0) = TMath::Cos(theta);
00190 (*DerivativeMatrix)(3,0) = r/_pcurr.E();
00191
00192
00193 (*DerivativeMatrix)(0,1) = r*TMath::Cos(phi)*TMath::Cos(theta);
00194 (*DerivativeMatrix)(1,1) = r*TMath::Sin(phi)*TMath::Cos(theta);
00195 (*DerivativeMatrix)(2,1) = -1.*r*TMath::Sin(theta);
00196 (*DerivativeMatrix)(3,1) = 0.;
00197
00198
00199 (*DerivativeMatrix)(0,2) = -1.*r*TMath::Sin(phi)*TMath::Sin(theta);
00200 (*DerivativeMatrix)(1,2) = r*TMath::Cos(phi)*TMath::Sin(theta);;
00201 (*DerivativeMatrix)(2,2) = 0.;
00202 (*DerivativeMatrix)(3,2) = 0.;
00203
00204 return DerivativeMatrix;
00205
00206 }
00207
00208 TMatrixD* TFitParticleMCSpher::transform(const TLorentzVector& vec) {
00209
00210
00211
00212
00213 TMatrixD* tparams = new TMatrixD( _nPar, 1 );
00214 (*tparams)(0,0) = vec.P();
00215 (*tparams)(1,0) = vec.Theta();
00216 (*tparams)(2,0) = vec.Phi();
00217
00218 return tparams;
00219
00220 }